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Abstract 


The  available  measurements  from  a  strapaown  seeker  and 
a  gimbalied  seeker  onboard  an  air-to-ground  ant i -rad iation 
missile  are  analyzed  through  an  extended  Kalman  filter 
simulation.  Detailed  models  of  both  seekers  are  developed. 
Only  angular  measurements  are  assumed  available  from  the 
seekers:  angle  measurements  from  the  strapdown  seeker  and 
angle  and  angle-rate  measurements  from  the  giiTiballed 
seeker.  A  6-state  extended  Kalman  filter  model  is  used  to 
estimate  the  ground  target's  position  and  relative  velocity 
using  the  seekers'  measurements.  four  measurement  policies 
are  compared  to  analyze  use  of  the  gimbalied  seeker  early 
in  the  missile  flight  and  loss  of  the  strapdown  seeker  in 
midf light. 

The  results  revealed  an  observability  problem  in  one 
channel  of  the  filter,  that  along  the  range  vector. 
Analyses  were  made  only  by  comparisons  of  performance  in 
the  other  two  channels.  The  comparisons  showed 
insignificant  degradation  to  filter  performance  through 
loss  of  the  strapdown  seeker  at  midflight,  and  substantial 
benefit  from  use  of  the  gimbalied  seeker  as  early  as 
possible  in  the  flight. 
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DUAL-SEEKER  MEASUREMENT  PROCESSING 
FOR  TACTICAL  MISSILE  GUIDANCE 

I .  INTRODUCTION 

Background 

The  air-to-ground  anti-radiation  missile,  or  ARM,  is  a 
weapon  typically  intended  for  use  against  active  enemy 
radar  sites.  Guidance  for  the  ARM  after  launch  is 
dependent  upon  a  seeker  which  provides  information  about 
the  relative  position  of  the  target  with  respect  to  the 
missile.  The  seeker  information  may  be  supplemented  by 
other  information  such  as  missile  inertial  accelerations 
from  an  inertial  measuring  unit  (IMU).  Present 
anti-radiation  missiles,  such  as  the  AGM-45A  Shrike  and  the 
AGm-78  Standard  ARM,  employ  passive  radar  seekers  to 
provide  guidance  information.  Since  a  passive  radar  seeker 
relies  solely  on  target  emissions  for  successful  operation, 
an  inherent  problem  in  present  anti-radiation  missiles  is 
target  emitter  shutdown. 

A  possible  solution  to  the  emitter  shutdown  problem  is 
the  use  of  two  separate  seekers,  one  of  which  is 
semi-active  or  passive  electro-optical  and,  therefore,  not 
dependent  on  radar  emissions  from  the  target.  One  such 
dual-seeker  configuration  under  consideration  by  the  Air 
Force  Armament  Test  Laboratories  (AFATL),  Eglin  AFB, 


Florida,  is  a  body-fixed,  or  strapdown,  passive  radar 
seeker  installed  on  an  AGM-65  Maverick  missile.  The  AGM-65 
missiles  are  already  equipped  with  a  gimballed  seeker  that 
is  either  passive  television,  passive  infrared,  or 
semi -active  laser.  The  concept  of  employing  a  strapdown 
seeker  for  missile  guidance  is  relatively'  new.  At  present, 
strapdown  seeker  guidance  is  being  explored  at  AFATL  ar.d 
has  only  been  implemented  in  the  limited  case  of  an 
anti-ship  missile  (Ref  10).  If  the  dual-seeker  missile 
were  to  be  implemented,  a  major  design  consideration  is  how 
to  use  the  information  from  both  seekers.  The  motivation 
for  this  thesis  is  to  explore  the  possibilities  in  guidance 
transition  between  the  two  seekers. 

Theory 

The  major  difference  between  gimballed  and  strapdown 
seekers  is  that  the  information  provided  mechanically  by  a 
gimballed  seeker  is  derived  electronically  in  a  strapdown 
seeker.  Such  information  may  be  the  azimuth  and  elevation 
angles  of  the  line-of -sight  (LOS)  to  the  target,  the  rates 
of  change  of  these  angles,  target  range,  and  target 
range-rate.  The  other  important  difference  is  the 
coordinate  frame  to  which  the  inf ori, nation  is  referenced. 
To  implement  most  guidance  techniques,  inertially 
referenced  angle  information  is  necessary.  Further 
explanation  of  the  operation  of  gimballed  and  strapdown 
seekers  will  clarify  the  importance  of  their  differences. 
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A  gimbailed  seeker  is  characterized  by  the  ability  to 
rotate  its  sensitive  axis  with  respect  to  the  missile. 
This  rotation  is  typically  about  two  gimbals  which  are 
rotated  by  torquer  motors  to  keep  the  seeker  antenna 
centerline  on  the  LOS  to  the  target.  The  LOS  can  then  be 
quantitized  by  potentiometer  measurements  of  the  two  gimbal 
angles.  Inertially-referenced  azimuth  and  elevation  angle 
rates  can  be  measured  directly  from  rate  gyroscopes  on  the 
inner  gimbal. 

The  basic  gimbailed  seeker  is  depicted  in  Figure  1-1. 
As  shown  in  the  figure,  the  instantaneous  field  of  view 
CFOV)  is  the  angular  region  about  the  seeker  boresight  from 
which  it  receives  usable  energy.  The  total  FOV  is  the 
region  swept  out  by  the  instantaneous  FOV  as  the  gimbals 
are  rot.' ted  to  their  limits. 

A  strapdown  seeker,  on  the  other  hand,  is  fixed  to  the 
body  of  the  missile.  Such  a  seeker  operates  by 
electronically  measuring  the  LOS  angles  with  respect  to  the 
missile  body  and,  possibly,  the  range  and/or  range-rate  to 
the  target.  Inertial  LOS  rates  cannot  be  measured  directly 
from  a  strapdown  seeker.  Theoretically,  LOS  rates  can  be 
derived  from  LOS  angles  and  body  rate-gyro  outputs,  but 
usually  a  derivative  network  is  involved,  leading  to 
stability  problems  (Ref  8:1).  This  fact  is  an  inherent 
problem  in  strapdown  seeker  guidance  and  will  be  discussed 
further. 
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There  are  two  basic  types  of  strapdown  seekers: 
"staring"  and  "beam  steered."  Sketches  of  these  are 
presented  in  Figure  1-2.  The  beam  steered  is  like  a 
gimballed  seeker  in  that  it  has  a  small  instantaneous  FOV 
which  can  be  moved  relative  to  the  missile  body.  An  active 
radar  seeker  with  phased  array  antenna  is  an  example  of 
beam  steering.  The  staring  type  has  an  instantaneous  FOV 
equal  to  the  total  FOV.  An  example  of  a  staring  strapdown 
seeker  is  the  semi-active  laser  seeker  with  a  wide  FOV. 
Another  kind  of  strapdown  seeker  that  has  been  investigated 
is  the  "multiarm  flat  spiral  antenna"  interferometer 
seeker  (Refs  10;13). 

Since  the  missile  concept  explored  in  this  thesis  is 
an  ARM  equipped  with  both  a  strapdown  passive  radar  seeker 
and  a  gimballed  passive  electro-optical  or  semi-active 
laser,  the  specific  information  available  from  these 
seekers  must  be  specified.  Active  or  semi-active  radar 
seekers  are  the  only  ones  which  currently  provide 
missile-to-target  range  and/or  range  rate  (Ref  12:3-4). 
Since  neither  seeker  considered  here  is  active  or 
semi-active  radar,  range  and  range-rate  are  not  considered 
available  from  either.  As  discussed  earlier,  the  gimballed 
seeker  is  capable  of  providing  direct  measurements  of  LOS 
angles  and  inertially-referenced  angle-rates.  Therefore, 
this  information  is  assumed  available  from  the  gimballed 
seeker.  Although  work  has  been  done  towards  deriving  LOS 
angle-rates  from  the  LOS  angle  measurements  of  a  strapdown 
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gure  1-2.  Basic  Types  of  Strj  down  Seekers  (Ref  6) 


3eeker  (Refs  6 ; 8 ) ,  the  methods  explored  are  still  not  fully 
developed  or  tested.  For  this  reason,  only  the  LOS  angles 
directly  measured  by  the  strapdown  seeker  are  assumed  to  be 
available  from  it.  Through  the  course  of  this  study, 
however,  if  the  lack  of  angle-rate  measurements  from  the 
strapdown  seeker  prevents  a  realistic  analysis  of  the  two 
seekers,  pseudo  angle-rate  measurements  may  be  considered 
for  the  strapdown  seeker  model. 

The  dual  seeker  missile  proposed  by  AFATL  would  have 
inherent  flexibility,  but  the  guidance  information 
available  to  it  at  any  given  time  during  flight  would  be 
constrained  by  the  limitations  of  both  seekers.  Typically, 
a  radar  seeker  would  be  capable  of  acquiring  the  target  at 
longer  ranges  than  an  optical  seeker.  Again,  however,  the 
radar  seeker  may  lose  track  due  to  target  emitter  shutdown, 
so  that  the  missile  would  then  have  to  depend  on  the 
information  from  the  optical  seeker.  Depending  on  the 
trajectory,  the  optical  seeker  may  acquire  the  target  at 
launch  or  not  until  midflight.  Therefore,  t..<.  information 
available  is  a  function  of  range-to-target  and  detection  of 
the  approaching  missile  by  the  target.  Conceptually,  the 
measurement  policies  to  be  examined  are: 

1)  both  seekers  operative  throughout  flight. 

2)  strapdown  only  initially,  switch  on  gimballed  at 
time  of  target  shutdown. 

3)  both  seekers  initially,  loss  of  strapdown  at  time 
of  target  shutdown. 

4)  strapdown  only  initially,  both  seekers  when  gim¬ 
balled  acquires  target. 
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To  accomplish  this  study,  some  means  of  simulating  the 
use  of  the  guidance  information  available  must  be 
developed.  A  Kalman  filter  implementation  was  chosen 
because  of  its  ability  to  use  all  the  information  available 
to  it  and  to  weight  the  information  according  to  the 
confidence  afforded  it.  Also,  Kalman  filters  have  been 
used  successfully  in  numerous  missile  guidance  applications 
(Refs  3 ; 5 ;14 ; 17 ; 25  ) .  The  specific  Kalman  filter  chosen  for 
this  study  and  the  rationale  for  this  choice  will  be 
discussed  in  Chapter  III.  Given  the  preceding  development 
of  1  i  c  rr.G  tivstion  for  this  study,  the  theory  involved,  and 
a  means  for  achieving  the  desired  comparisons,  the  specific 
problem  and  objectives  of  this  thesis  can  now  be  presented. 

Statement  of  Problem  and  Objectives 

The  bulk  of  the  work  done  for  this  thesis  was  in  the 
development  of  adequate  models  for  the  seekers  involved  and 
in  incorporating  these  models  into  a  working  filter  design. 
The  goal  was  to  implement  a  simulation  on  a  digital 
computer  to  perform  the  desired  analyses  of  the  dual-seeker 
measurement  policies  given  in  the  preceding  section.  The 
objectives  of  this  thesis  can  be  summarized  as  follows: 

1)  Develop  detailed  "truth"  models  of  the  missile 
and  the  two  seekers. 

2)  Develop  a  tractable  reduced  order  Kalman  filter 
design  to  use  the  measurements  available  from  the 
seeker  models. 

3)  Run  analyses  of  the  proposed  dual-seeker  measure¬ 
ment  policies  using  this  filter  design. 

4)  Discuss  the  results  of  the  above  three. 
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Assumptions 


The  maximum  time  of  flight  of  the  missile  simulated  in 
this  thesis  is  approximately  28  seconds.  For  this 
relatively  short  time  of  flight,  an  earth-fixed  navigation 
frame  was  assumed  to  be  essentially  inertial.  Such  a  frame 
consists  of  three  axes,  typically  in  north,  east,  and  down 
directions,  and  is  fixed  at  a  point  on  the  surface  of  the 
earth.  For  the  accelerations  involved  in  this  study,  an 
analysis  of  this  assumption,  using  nominal  values  of  range 
and  missile  velocity  and  acceleration,  showed  that  it 
introduced  an  inertial  acceleration  error  of,  at  most,  four 
percent.  This  small  error  is  assumed  to  be  negligible  in 
the  comparison  of  the  two  seekers  since  they  are  mounted 
together  on  the  same  missile  and  since  their  relative 
errors  are  much  larger. 

In  order  to  concentrate  the  major  effort  of  this 
thesis  on  the  seeker  models  and  filter  design,  an  inertial 
navigation  system  (INS)  is  assumed  to  provide  nearly 
perfect  inertial  accelerations  of  the  missile  and  perfect 
Euler  angles  between  the  missile  body  frame  and  the  local 
level  frame.  Hence,  an  error  model  of  the  INS  is  not 
employed  in  this  thesis  beyond  that  of  white  Gaussian  noise 
modelling  the  error  in  the  INS  accelerations. 

Organization 

Chapter  II  of  this  thesis  is  the  explanation  of  the 
missile  model  employed  and  the  development  of  the  two 
seeker  truth  models.  Chapter  III  presents  the  Kalman 
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filter  theory  for  the  specific  filter  used  and  the  filter 
design.  Chapter  IV  is  a  discussion  of  the  method  used  for 
implementing  the  filter  and  truth  models  and  for  evaluating 
the  performance  of  the  filter  for  the  proposed  measurement 
policies.  Chapter  V  presents  the  results  of  the  analyses, 
and  Chapter  VI  summarizes  this  work  with  conclusions  drawn 
from  the  results  and  with  recommendations  for  future  study. 
The  appendices  include  the  development  of  the  detailed 
mathematics  of  the  truth  model  and  filter  implementation 
and  the  graphs  depicting  the  results  of  the  analyses. 


II.  TRUTH  MODEL 


Introduction 

A  truth  model  is  the  best  mathematical  model  of  the 
systems  involved  in  problem  of  interest,  given  knowledge  of 
their  operation  in  the  "real  world."  It  is  developed  to 
provide  a  baseline  for  the  Kalman  filter  design  and  a  model 
against  which  the  filter  can  be  run.  The  particular  truth 
model  used  in  this  thesis  is  based  on  an  air-to-grcund 
missile  flight  simulation  provided  by  AFATL,  the  Low-Level 
Laser-Guided  Bomb  (LLLGB)  program  (Ref  16).  The  LLLGB 
output  used  is  a  detailed  computer  simulation  of  a  typical 
non-thrusting ,  guided  air-to-ground  missile  run.  It 
provides  missile  position,  velocity,  and  acceleration  with 
respect  to  an  earth-fixed  inertial  frame  and  Euler  angles 
and  angle-rates  of  the  missile  with  respect  to  the  local, 
noninertially  rotating  frame.  The  use  of  this  simulation 
as  a  missile  truth  model  and  as  input  to  the  seeker  models 
is  facilitated  by  making  the  following  cusunptions . 

Assumptions 

Since  the  target  is  earth-fixed,  it  will  be  assumed  to 
be  located  at  the  origin  used  in  the  LLLGB  simulation. 
Therefore,  measurements  which  are  functions  of  the  relative 
position  and  velocity  of  the  target  with  respect  to  the 
missile  are  also  functions  of  the  inertial  position  and 
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velocity  of  the  missile.  The  seekers  are  assumed  to  be 
located  at  the  same  point  on  the  missile,  the  missile's 
center  of  gravity,  in  order  to  simplify  the  measurement 
equations.  The  seekers  are  assumed  to  operate 
independently  and  not  to  influence  the  missile  trajectory. 
In  other  words,  the  seekers  will  only  provide  measurements 
to  the  filter  algorithm  and  are  not  in  the  closed  loop  of 
the  missile's  true  dynamics.  Inclusion  of  the  seekers  in  a 
closed  loop  guidance  law  is  a  considerably  more  complex 
study.  Since  the  development  of  good  seeker  models  and  the 
implementation  of  the  filter  design  presented  a  distinct 
challenge  in  themselves,  such  a  guidance  law  study  was  not 
attempted  for  this  thesis. 

Missile  Model 

As  stated  previously,  the  missile  model  is  defined  as 
the  one  used  in  the  LLLGB  simulation.  In  this  program,  the 
earth-fixed  coordinate  frame  is  defined  by  the  missile 
release  conditions  as  shown  in  Figure  2-1.  The  xe~axis  is 
parallel  to  the  initial  velocity  vector  in  the  earth  frame. 
The  xg-ye  plane  is  tangent  to  the  earth  plane,  and  the 
ze-axis  points  tc  the  center  o:  the  earth.  As  explained  in 
the  assumptions  section  of  Chapter  I,  this  earth-fixed 
frame  is  considered  to  be  the  inertial  frame  in  this  thesis 
and  will  be  referred  to  as  the  inertial  frame  from  now  on. 
The  missile  flies  from  initial  release  conditions  of 
(-20000.,  0.,  -500.)  ft  at  an  initial  velocity  vector  of 
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Figure  2-1.  Earth-Fixed  Frame 


(843.9,  0.,  0.)  ft/sec  (about  Mach  0.75  in  the 
xe  -direction)  to  a  point  at  a  slantrange  of  529.8  ft  to  the 
earth-frame  origin,  with  less  than  one  second  left  until 
impact.  The  dominant  motion  of  the  missile  is  in  the 
xe-ze  plane,  the  largest  deviation  in  the  ye  -direction 
being  45  ft.  A  plot  of  the  missile  flight  path  in  the 
xe  -ze  plane  is  found  in  Figure  2-2.  The  trajectory  was 
terminated  short  of  impact  because  the  final  conditions  of 
the  simulation  are  classified.  As  it  is,  the  simulation 
run  is  28.5  sec  long  with  data  points  provided  every 
0.1  sec,  which  will  be  the  sample  period  used  for  this 
study. 

A  frame  that  was  not  used  in  the  LLLGB  simulation  but 
which  will  be  incorporated  ,nto  this  thesis  is  the  missile 
frame.  The  origin  of  the  missile  frame  is  located  at  the 
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center  of  gravity  of  the  missile,  and  the  frame  does  not 
rotate  with  respect  to  the  inertial  frame.  The  missile 
frame,  therefore,  translates  with  the  missile  in  flight, 
but  its  three  axes,  xm,  ym,  and  z  ,  are  always  parallel  to 
the  three  corresponding  inertial  axes.  The  missile  frame 
provides  a  reference  for  the  next  coordinate  frame  to  be 
discussed,  the  body  frame. 

The  body-fixed  coordinate  frame,  as  used  in  the  LLLGB 
simulation  and  in  this  thesis,  is  depicted  in  Figure  2-3. 


Figure  2-3.  Body-Fixed  Frame 


The  body  frame  also  has  its  origin  at  the  missile  center  of 
gravity  and  translates  with  respect  to  the  inertial  frame. 
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but  rotates  with  the  missile  with  respect  to  the  inertial 
and  missile  frames.  In  the  usual  mounting  configuration  on 
an  airplane  in  level  flight,  the  y.  and  axes  make  angles 
of  45°  with  the  xm~ym  plane. 

The  missile  Euler  angles  relate  the  orientation  of  the 
body-fixed  frame  with  respect  to  the  missile  frame  and  are 
defined  as  e,  i ,  and  $  for  pitch,  yaw,  and  roll.  The  order 
of  rotation  used  is  pitch,  yaw,  and  roll,  so  that  the 
transformation  matrix  from  the  missile  frame  is  given  by 
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where  the  superscripts  indicate  the  frame  in  which  the 

vector  is  written,  V  is  any  vector  in  the  given  frame,  and 
b 

is  the  coordinate  transformation  matrix  from  the  missile 
frame  to  the  body  frame.  The  relationship  between  the 
three  frames  discussed  thus  far  is  seen  in  the  following 
diagram. 
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The  aerodynamic  forces  and  moments  are  expressed  in 


the  body-f.Lxed  frame.  The  forces  are  computed  as  follows: 

Fx  =  ”  Q 's  ‘ca  (  2) 

Fy  =  -  Q  ‘S  ‘Cnb  (3) 

F2  =  -  Q-S-Cna  (4) 

where  Q  is  the  dynamic  pressure,  S  is  the  reference  surface 
area,  and  Ca ,  ,  and  Cna  are  the  axial  force,  normal 

force  along  y,  and  normal  force  along  z  aerodynamic 
coefficients,  respectively.  The  subscripts  x,  y,  and  z 
indicate  the  axis  along  which  the  forces  are  directed. 

These  forces  and  the  body  velocities,  accelerations, 
angular  velocities,  and  angular  accelerations  are  depicted 
in  Figure  2-4.  The  angular  accelerations  (derivatives,  of 


Figure  2-4.  Missile  Body  Dynamics 


angular  rates  P  about  *5,  Q  about  yb  ,  and  R  about  zb  )  are 
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computed  by: 


P  =  M  /I 

(5) 

X  X 

<2  =  fM  -  R>P  -(I 

1  y  x 

-  Io>J/Io 

(6) 

R  »  [Mz  +  P-Q*(IX 

- 

(7) 

where  Ix  is  moment  of  inertia  about  the  x^  -axis  and  IQ  is 
moment  of  inertia  about  either  the  y^-  or  z^-  axis.  The 
body  moments  Mx,  My,  and  Mz  are  given  by: 


Mx 

=  0 

(8  ) 

r 

D  1 

My 

=  QSD 

^ma ^ a' ^  p  ^  + 

+  )  2\ 

+  Fz*xcg 
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D 

Mz 

=  QSD 

Cmb  ^  *  + 

*  “cm6i^  +  cm0R  *  TV 

J  ~  Fy*xcg 

(10  ) 

where  D  is  the  reference  diameter  and  XCg  is  the  shift  of 
center  of  gravity  along  the  x^  -axis.  6p  and  <5y  are  pitch 
and  yaw  canard  positions,  respectively,  and  V  is  the 
velocity  magnitude.  The  angle  of  attack,  a,  and  sideslip, 
8,  are  given  by: 


a  =  tan"1 

(W/U) 

(11  ) 

8  =  tan"1 

(V/U) 

(12  ) 

Cma  and  Cmb  are  the 

static  moment 

coefficients  about  y 

and  z,  respectively;  and 

Cmd  and  cmfi 

are  the  dynamic  moment 

coefficients  for  the  rate  of  change  of  angle  of  attack  and 
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for  the  rate  of  change  of  the  pitch  angle,  respectively. 

The  accelerations  ,-n  the  body  frame  are  computed  by 
the  following: 
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where  m  is 

the 

body 

mass  and 

g  is 

acceleration 

due  to 

gravity.  The  rotational  velocity  terms  are  due  to  taking 
the  derivatives  in  a  noninertial  reference  frame  using  the 
theorem  of  Coriolis.  In  the  simulation,  U,  V,  and  W  are 
integrated  using  a  4th-order  Runge-Kutta  method  to  give  U, 
V,  and  W  which  are  then  rotated  to  the  earth-fixed  frame. 
These  inertial  velocities  are  then  integrated  to  give 
inertial  position. 

Similarly,  P,  Q,  and  R  are  integrated  to  produce  P,  Q, 
and  R,  the  angular  velocities  in  the  body  frame.  These  are 
transformed  via  C™  (see  eq.  (1))  to  give  3,  ip,  and  <J>,  the 
angular  velocities  in  the  inertial  frame,  which  are  then 
integrated  to  compute  the  missile's  orientation. 

In  order  to  understand  the  equations  of  motion,  the 
following  description  of  the  aerodynamic  coefficients  is 
given.  The  sense  of  the  moment  coefficients  are  such  that: 
for  g  =  g  =  0 

a  positive  6p  gives  a  positive  Cma 
a  positive  6y  gives  a  positive  Cmb 
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for  6p  =  6y  =  0 

a  positive  a  gives  a  negative  Cna 
a  positive  0  gives  a  negative  Cnjb 

The  sense  of  the  normal  force  coefficients  are  such  that: 

for  a  =  6  =  0 

a  positive  6p  gives  a  positive  Cna 
a  positive  6y  gives  a  positive  Cnb 

for  Sp  =  6  —  0 

a  positive  a  gives  a  positive  Cna 
a  positive  6  gives  a  positive  Cnb 

Cmb  and  Cmg  have  negative  values  and  are  only  a  function  of 

mach  number. 

Given  the  preceding  description  of  the  LLLGB 
simulation,  the  reader  should  recognize  the  complexity  of  a 
detailed  missile  simulation.  using  such  a  simulation  made 
it  possible  to  take  advantage  of  a  good  missile  truth  model 
and  yet  concentrate  most  of  the  original  design  work  on  the 
seeker  models.  The  LLLGB  simulation  was  chosen  by  the 
sponsor  of  this  thesis  to  be  a  typical  trajectory  for  the 
conceptual  dual-seeker  missile.  The  constant  parameters  in 
eqs.  (2)  through  (15)  are  documented  in  Ref  7. 

Measurement  Model 

As  mentioned  in  Chapter  I,  missile  seekers  provide 
information  about  the  target  relative  to  the  missile.  This 
information  can  most  readily  be  quantized  in  the 
line-of -sight  (LOS)  frame  as  depicted  in  Figure  2-5.  In 
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Figure  2-5.  LOS  Frame  and  Azimuth  and  Elevation  Angles 

the  above  figure,  the  subscripts  "L"  and  "r"  refer  to  the 
LOS  frame  axes  and  the  axes  of  some  arbitrary  reference 
frame,  respectively.  The  angle  u  is  the  azimuth  angle  of 
the  LOS  with  respect  to  the  reference  frame;  e  is  the 
elevation  angle*  of  the  LOS  with  respect  to  the  reference 
frame.  Typically,  the  reference  frame  is  the  missile  frame 
or  the  body  frame,  depending  on  the  seeker.  The  coordinate 
transformation  between  the  LOS  frame  and  the  reference 
frame  is  given  in  Appendix  A. 

*The  knowledgeable  reader  will  note  that  e  is  actually  the 
depression  angle.  e  was  chosen  positive  as  shown  to 
simplify  the  measurement  equations  and  will  be  referred  to 
as  elevation  for  simplicity  henceforth. 
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As  noted  before,  some  seekers  provide  both  azimuth  and 
elevation  angles  and  azimuth  and  elevation  angle-rates.  An 
active  seeker,  such  as  an  active  radar  seeker,  provides 
information  about  range  along  the  LOS.  Since  such  a  seeker 
is  not  modelled  in  this  thesis,  discussion  about 
measurements  is  restricted  to  angular  information  only. 

The  azimuth  angle,  therefore,  is  defined  as  the  angle 
between  the  LOS  and  its  projection  into  the  xr-zr  plane. 
Elevation  is  defined  as  the  angle  between  the  LOS  projected 
into  the  xr-zr  plane  and  the  xf  axis.  Numerically,  the 
angles  are  given  by  the  following: 


a  =  tan 


- 1 


e  =  tan' 


f,  2 


•J. 


y’^J 

r  J 


(16  ) 


(17  ) 


The  angle  rates  can  be  found  by  taking  the  first  derivative 
of  eqs,  (16)  and  (17)  with  respect  to  time.  The  resulting 
azimuth  rate  and  elevation  rate  are  given  by  the  following: 


xv  -  v  v 

r  yr  Xr  *r 

(xr2  ♦  yrz) 


(18  ) 


e  = 


(xr2  +  yr2)vZr  -  (xrvXr  *  yrvyr)zr 
(x r 2  ♦  yr2)'  (xrT  +  yr2  +  zr2) 


(19) 


where  V  ,  V  ,  V  are  the  components  of  the  velocity  of 
*r  zr 

the  target  with  respect  to  the  missile  in  the  reference 
frame . 

The  relationship  between  all  the  frames  used  in  this 
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thesis  is  seen  in  the  following  diagram. 


With  this  description  of  the  measurements,  the  two  seeker 
models  are  now  developed  as  parts  of  the  system  (overall) 
truth  model. 

Strapdown  Seeker  Model 

As  discussed  previously,  one  of  the  seekers  modeled  in 
this  thesis  is  a  body-fixed  passive  radar  seeker.  A  model 
for  this  seeker  was  provided  by  the  sponsor  at  AFATL 
(Refs  6 ;  8 ) ,  and  is  shown  in  Figure  2-6.  This  model  was 
developed  for  a  strapdown  seeker  study  done  by  the  Missile 
Systems  Division  of  Rockwell  International  for  AFATL.  It 
simulates  the  measurements  generated  by  a  strapdown  passive 
radar  seeker  and  the  noises  which  would  corrupt  such 
measurements . 

The  measurements  are  seen  to  be  derived  from  the  true 
target  position  in  inertial  coordinates.  This  position  is 
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Figure  2-6.  Strapdown  Seeker  Model 


first  corrupted  by  additive  glint  noise,  then  rotated  by  an 
orthogonal  transformation  to  missile-body  coordinates.  The 
azimuth  and  elevation  angles  of  the  target  with  respect  to 
the  missile  are  calculated  from  the  glint-corrupted  target 
position  in  body  coordinates.  Finally,  two  other  additive 
noises:  thermal  noise  and  boresight  error;  and  three 
multiplicative  noises:  cross-coupling,  radome  distortion, 
and  detector  scale-factor;  all  corrupt  the  azimuth  and 
elevation  angles.  A  description  of  these  six  noises 
follows . 

Glint  Noise.  Glint  noise  has  been  referred  to  as 
"angle  scintillation"  in  previous  studies 
(Refs  5:23;  17:28).  Glint  noise  is  the  disturbance  in 
apparent  angle  of  arrival  of  the  received  signal  due  to 
interferences  (i.e.,  phase  distortions).  Physically,  glint 
can  be  thought  of  as  wandering  of  the  apparent  center  of 
radar  signal  source.  Because  of  glint  noise,  the  apparent 
target  center  may  cfcen  lie  well  outside  the  physical 
limits  of  the  target  (Ref  2).  The  importance  of  glint  can 
be  easily  seen  in  that  a  large,  abrupt  variation  in 
measured  radar  angle  will  be  interpreted  as  a  change  in  the 
angular  velocity  of  the  target  relative  to  the 
missile  (Ref  17:28). 

Lutter  found  that  a  first  order  Gauss-Markov  process 
provides  a  good  fit  to  the  ensemble  statistics  of  the  glint 
spectrum,  the  same  model  used  for  glint  noise  in  the 
Rockwell  study  (Ref  17:28).  Modelling  glint  noise  as  the 
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output  of  a  first  order  lag  driven  by  white  Gaussian  noise 
allows  for  varying  target  sizes  and  velocities  through  the 
choice  of  appropriate  lag  time  constant  and  input  noise 
strength.  in  general,  glint  will  vary  inversely  with  range 
and  the  instantaneous  cross  section  of  the  target.  Since 
the  target  is  assumed  to  be  a  point  mass,  varying  target 
aspect  will  not  oe  included  in  the  glint  noise.  The  time 
constant  chosen  was  0.1  sec  since  it  was  used  both  by 
Rockwell  and  Lutter.  The  input  noise  standard  deviation 
was  chosen  to  be  2  ft/sec,  the  nominal  value  used  by 
Rockwell . 

Thermal  Noise.  Thermal  noise  is  generated  by  the 
background  radiation  from  environmental  and  receiver 
effects.  Thermal  noise  varies  inversely  with 
signal-to-noise  ratio,  which  in  turn  varies  inversely  with 
range  (Ref  17:29).  Therefore,  thermal  noise  is  directly 
proportional  to  range.  The  model  for  thermal  noise  shown 
in  Figure  2-6  is  discrete-time  white  Gaussian  noise,  which 
is  the  typically  used  model  (Ref  17:29).  The  strength  of 
the  thermal  noise  can  be  expressed  as: 

<j^2  =  (K  x  range)2  (20) 

The  coefficient  K  in  eq.  (205  was  calculated  using  a 
nominal  value  at  a  given  range  in  (Ref  8:117)  and  was  found 
to  be  1. 0  x  10  7  ft  *  . 
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Boresight  Error.  This  noise  models  the  error 
introducted  by  calibration  inaccuracies  in  seeker  mounting. 
It  can  be  considered  to  be  constant  for  any  one  seeker 
mounting,  so  that  a  good  model  for  boresight  error  is  a 
random  bias.  This  is  the  model  incorporated  in  this 
thesis,  and  determination  of  the  initial  conditions  for 
this  and  some  of  the  following  bias  noises  came  from  the 
Rockwell  study.  These  initial  conditions  are  summarized  in 
Table  I  following  the  discussion  of  the  three 
multiplicative  noises. 

Radome  Distortion.  This  multiplicative  noise  must  be 
considered  first  as  it  affects  the  actual  energy  received 
by  the  seeker  antenna.  Also  called  aberration  error, 
radome  distortion  is  caused  by  the  protective  covering  of 
the  antenna.  The  geometry  of  the  strapdown  seeker  in  one 
dimension  is  shown  in  Figure  2-7.  The  antenna  is  assumed 
to  be  aligned  with  the  missile  body  frame  so  that  the 
seeker  centerline  is  along  the  x^-axis.  The  angle  e  repre¬ 
sents  either  the  azimuth  or  elevation  angle  measured  by  the 
seeker.  The  inertially  referenced  LOS  angle  is  defined  to 
be  0,  and  the  angle  between  the  missile  centerline  and 
inertial  reference  in  the  azimuth  or  elevation  angle  plane 
is  0  .  Radome  distortion  is  the  result  cf  nonlinear 
distortion  in  the  received  energy  as  it  passes  through  the 
antenna  cover.  This  aberration  produces  a  false 
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the  missile  guidance  system.  As  shown  in  Figure  2-8, 


=  6 


0  _  -  e. 


m 


(21  ) 


*Note:  The  LOS  is  corrupted  by  glint  and  thermal  noise  at 
this  point. 
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Figure  2-8.  Effect  of  Radome  Distortion  on  Strapaown  Seeker- 


6  can  be  a  nonlinear  function  of  several  error 

r 

sources:  e  ,  physical  and  geometrical  properties  of  the 
antenna  cover,  polarization  of  the  received  signal,  and 
erosion  of  the  antenna  cover's  surface  during  flight. 
Lutter  found  that,  due  to  the  wide  ranges  of  variation  in 


*Note:  Again,  the  LOS  is  corrupted  by  glint  and  thermal 
noise  at  this  point. 
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these  error  sources,  aberration  error  is  adequately 
described  by  a  constant  slope  model  (Refs  13;  17:12). 

Therefore,  a  linear  model  for  the  error  due  to  radome 
distortion  is  given  by 

er  ■  erb  -  krc  <22) 

where  6^  is  the  aberration  error  bias  and  ^  is  the  error 
slope.  Because  of  the  lack  of  specific  data  to  indicate 
otherwise,  6  ^  will  be  assumed  to  be  zero  for  this  study. 
The  nominal  value  of  kf  was  found  by  Lutter  to  be 

0.001  rad/rad,  which  correlates  well  with  the  Rockwell 
study  (Ref  8:117). 

Scale  Factor  Error.  Detector  scale  factor  error  is  a 
function  of  the  seeker  receiver’s  resolution,  sensitivity, 
and  electronics.  Quantitatively,  it  is  the  difference 
between  the  best  straight  line  fit  of  the  seeker  transfer 

function  and  unity  (Ref  8:13).  In  the  Rockwell  study, 

scale  factor  error  was  modelled  as  a  deterministic 
constant.  In  order  to  implement  as  generic  a  model  as 
possible,  scale  factor  error  is  modelled  here  as  a  random 
bias.  The  maximum  value  of  scale  factor  error  employed  by 
Rockwell  was  considered  to  be  a  3o  value  for  the  initial 
condition  for  the  bias.  The  one-sigma  value  is  given  in 
Table  I,  which  follows  the  discussion  of  the  last  noise  in 
the  strapdown  seeker  model,  cross-coupling. 
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Cross-Coupling.  This  noise  is  also  caused  by  seeker 
receiver  effects  and  appears  as  a  bias  in  the  output 
signal.  The  strength  of  this  bias,  however,  is  a  function 
of  the  measurement  in  the  other  channel  of  the  seeker.  In 
other  words,  the  amount  of  cross-coupling  error  in  the 
azimuth  measurements  depends  upon  the  elevation  measurement 
magnitude  and  vice-versa.  This  noise  is  also  well-modelled 
as  a  random  bias,  and  the  one-sigma  value  for  the  initial 
condition  was  determined  in  the  same  way  as  that  for  scale 
factor  error.  The  statistics,  of  the  strapdown  seeker  truth 
model  noises  are  summarized  in  Table  I. 


Table  I 

Statistics  of  Strapdown  Seeker  Truth 
Model  Noises 


Noise 

0 

t 

Glint 

2  ft/sec 

0.1  sec 

Thermal 

( 1  x  10  rad/ft)  x  range 

— 

Boresight 
error  I.C. 

0.0006  rad 

— 

Scale  factor 
error  I.C. 

0.03 

— 

Cross -coup ling 
error  I.C. 

0.003 

— 

Incorporating  the  modelling  for  the  strapdown 
measurements,  the  model  for  the  strapdown  seeker  is  given 
in  detail  in  Figure  2-9. 
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Figure  2-9.  Strapdown  Seeker  Block  Diagram 


Gimballed  Seeker  Model 


The  gimballed  seeker  model  used  in  this  thesis  is  a 
generic  model  designed  to  be  approximately  the  same  order 
of  complexity  as  the  strapdown  seeker  model  of  Figure  2-6. 
As  discussed  in  Chapter  I.  a  gimballed  seeker  provides 
inertial  measurements  of  LOS  and  LOS  rate  from  the  seeker 
boresight.  Therefore,  the  major  difference  between  the 
gimballed  seeker  model  and  the  previously  developed 
strapdown  seeker  model  is  the  inclusion  of  seeker  dynamics. 
These  dynamics  will  be  incorporated  assuming  an  inertially 
referenced  seeker.  In  other  words,  the  gimbal  angles  are 
referenced  to  the  missile  frame,  not  the  body  frame,  in  the 
dynamics  model.  The  gimbal  angles  relative  to  the  body 
frame  are  calculated  as  necessary  using  the  Euler  rotation 
matrix  of  eq.  (1)  and  the  inertially  referenced  gimbal 
angles. 

A  general  diagram  of  the  gimballed  seeker  model  is 
given  in  Figure  2-10.  This  model  includes  all  of  the 
noises  used  in  the  strapdown  seeker  model.  It  also  adds 
one  additive  noise,  rate  gyro  noise,  which  corrupts  the 
gimbal  angle  rates  from  the  seeker  dynamics.  Also,  the  LOS 
angles  are  calculated  from  the  target  location  plus  glint 
noise,  both  in  the  missile  frame;  this  is  in  contrast  to 
the  strapdown  seeker  model  in  which  the  LOS  angles  are 
calculated  from  the  target  location  plus  glint  noise  in  the 
body  frame.  The  seeker  dynamics  will  be  discussed  next. 
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Figure  2-10.  Gimballed  Seeker  Model 


Gimballed  Seeker  Dynamics.  The  seeker  dynamics  are 


the  result  of  the  seeker  antenna  tracking  loop.  The 
tracking  model  used  in  this  thesis  is  shown  in  one 
dimension  in  Figure  2-11. 


Figure  2-11.  Gimballed  Seeker  Dynamics 


In  the  figure,  e  is  the  error  angle  between  the  seeker 
boresight  and  the  LOS  and  0S  is  the  seeker  angle  referenced 
to  the  missile  frame.  The  gimbal  servo  motor,  the  gimbals, 
and  the  rate  gyro  are  the  key  physical  subsystems 
influencing  the  stabilization  dynamics.  The  loop  tracks  by 
commanding  a  gimbal  rate  proportional  to  the  error 
angle,  e-  The  loop  attempts  to  drive  e  to  zero,  thereby 
causing  the  antenna  to  track  the  target  (Ref  17:13). 

*Note:  Again,  this  angle  is  corrupted  by  glint  noise  and 
thermal  noise. 


I 
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Assuming  unity  low-frequency  (DC)  gain  for  the  signal 
processor  and  stabilization  dynamics,  the  assumed  model  for 
the  seeker  dynamics  is  given  by  the  transfer  function: 


e  1  +  si) 

so  that  the  error  angle  is  given  by: 

L  =  S  +  1/T  i  6 

a  first  order  lag  of  the  input  angle.  The  lag  constant  tir 
is  chosen  to  be  .075  sec  from  a  previous  study  in  which  a 
similar  seeker  model  was  used  (Ref  5:31).  With  the  seeker 
dynamics  thus  defined,  a  discussion  of  the  gimballed  seeker 
noises  follows. 

Gimballed  Seeker  Noises.  In  general,  the  noises  in 
Figure  2-10  have  the  same  effect  and  are  modelled  in  the 
same  way  as  in  the  strapdown  seeker  model.  Glint  noise 
enters  the  gimballed  seeker  model  in  the  same  way  and, 
conceptually,  has  the  same  effect  as  in  the  strapdown 
seeker  model.  Therefore,  in  order  to  make  as  fair  a 
comparison  between  the  two  seekers  as  possible,  glint  noise 
is  also  modelled  as  a  first  order  Gaussian  process  with  an 


input  noise  of  o  =  2 

ft/sec. 

For  the 

same 

reasons , 

thermal 

noise  in  the 

gimballed 

seeker 

model 

is  also 

modelled 

as  discrete-time 

white 

Gaussian 

noise 

with  the 

same  st 

andard  deviation 

as  in 

Tabla  I. 

Scale 

factor , 

cross-coupling,  and  boresight  error  are  again  biases, 


(23  ) 


(  24  ) 
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except  that  their  effect  is  on  the  measured  error  angles. 
Their  standard  deviations  are  also  chosen  to  be  the  same  as 
for  the  strapdown  seeker's  values  given  in  Table  I.  Radome 
distortion  is  affected  by  body  motion,  and  its  introduction 
in  the  gimballed  seeker  model  is  less  straightforward  than 
in  the  strapdown  seeker  model. 

As  shown  in  Figure  2-8,  radome  distortion  is  a 
function  of  the  LOS  angle  off  of  the  missile  centerline. 
In  the  gimballed  seeker  model,  however,  the  seeker 
centerline  rotates  with  respect  to  the  missile  centerline, 
and  the  error  angle  e  is  as  shown  in  Figure  2-12.  Since 


LOS  tc  Target  * 


Figure  2-12.  Gimballed  Seeker  —  Radome  Geometry 


*Note :  Again,  this  angle  is  corrupted  by  glint  noise  and 
thermal  noise. 
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9m  is  not  included  in  the  gimballed  seeker  model,  C$  and 
the  transformation  matrix  are  used  to  find  the  azimuth 
and  elevation  angles  of  the  LOS  with  respect  to  the  missile 
centerline.  The  procedure  for  introducing  radome 
distortion  in  the  gimballed  seeker  model  is  as  follows: 

1)  Find  the  unit  vector  along  the  LOS  in  the  missile 
frame. 

2)  Rotate  this  vector  to  the  body  frame. 

3)  Find  the  azimuth  and  elevation  angles  of  the  LOS 
with  respect  to  the  body  axes. 

4)  Corrupt  these  angles  by  as  in  (22). 

5)  Find  the  unit  vector  of  the  distorted  LOS  in  the 
body  frame. 

6)  Rotate  this  vector  back  to  the  missile  frame. 

7)  Find  the  azimuth  and  angles  of  the  distorted  LOS 
with  respect  to  the  missile  axes. 

The  procedure  for  accomplishing  Steps  1-3  is  found  in 

Appendix  A. 

The  only  noise  included  in  Figure  2-10  which  is  unique 
to  the  gimballed  seeker  model  is  the  rate  gyro  noise  which 
corrupts  the  LOS  rate.  This  noise  is  included  for 
completeness  since  a  rate  gyro  cannot  provide  exact  rate 
measurements.  A  discrete-time  white  Gaussian  noise  is 
chosen  as  the  model  for  rate  gyro  noise.  This  model  is 
used  because  it  captures  the  dominant  effects  of  short  term 
rate  gyro  noise.  For  the  time  of  flight  considered  here, 
long  term  gyro  drift  effects  are  negligible.  The  standard 
deviation  for  the  rate  gyro  noise  was  chosen  to  be 
1.0  mr ad/sec. 


38 


With  the  gimballed  seeker  model  thus  described,  a 
detailed  block  diagram  is  given  in  Figure  2-13.  The  noises 
and  their  standard  deviations  are  summarized  in  Table  II. 


Table  II 

Statistics  of  Gimballed  Seeker  Truth 
Model  Noises 


Noise 

— 

G 

Glint 

2  ft/s ec 

Thermal 

(1  x  10  rad/ft)  x  range 

Boresig  ht 
error  I.C. 

0.0006  rad 

Scale  factor 
error  I.C. 

0.03 

Cross-coupling 
error  I.C. 

0.003 

Rate  Gyro 

0.001  rad/sec 

Truth  State  Model.  The  system  truth  model  can  now  be 
expressed  as  a  vector,  stochastic,  ordinary  ditrerential 
equation  of  the  form: 

XsU)  =  gCXg.t)  +  Us(t)  ♦  WgCt)  (29) 

in  which: 

t  is  time 

XgCt)  is  the  truth  system  state  vector 

£(Xs,t)  is  the  truth  system  dynamics  vector 

Wg(t)  is  a  zero-mean  white  Gaussian  random 
process  with 

EiWgCt)  w|(x  +  t)}  =  Qs(t)  6  (t  ) 

Qs(t)  is  the  truth  system  noise  strength 
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AZIMUTH  RATE 
MEASUREMENT 
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Figure  2-13a.  Gimballed  Seeker  Block  Diagram 
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.  Gimballed  Seeker  Radome  Distortion  Block  Diagram 


In  the  above,  Ei  }  is  the  expectation  operation  and 
6(t)  is  the  Dirac  delta  function.  The  truth  state  vector 
is  comprised  of  the  six  position  and  velocity  states 
defined  by  the  LLLGB  simulation  and  the  noise  states  of  the 
two  seeker  models.  The  truth  state  vector  is  found  on  the 
following  page. 

In  the  truth  state  vector;  x,  y,  and  z  are  the 
coordinates  of  the  target  in  the  missile  frame;  vx  ,  vv  ,  and 
v.  are  the  velocities  of  the  target  relative  to  the  missile 
along  the  missile  frame  xm,  ym  ,  and  zm-axes,  respectively; 

is  the  azimuth  angle  between  the  gimballed  seeker 
boresight  and  the  xm  -axis;  is  the  elevation  angle 
between  the  gimballed  seeker  boresight  and  the  xm  -axis;  g, 
b,  s,  and  c  represent  glint,  boresight  error,  scale  factor, 
and  cross-coupling  states,  respectively;  and  the  subscripts 
s  a  i  g  represent  the  model,  strapdown  or  gimballed,  in 
which  the  noises  appear. 

The  truth  state  dynamics  equation  is  defined  in 
eq.  (26)  on  the  page  following  the  truth  state  vector.  In 
eq.  (26),  T 4  is  the  time  constant  of  the  glint  noises  in 
the  strapdown  seeker  model,  is  the  time  constant  of  the 
gimballed  seeker  dynamics  model,  T,  is  the  time  constant  of 
the  glint  noises  in  the  gimballed  seeker  model.  Also  in 
eq.  (26);  and  «3  are  the  white  noises  driving  the 
strapdown  seeker  glint  noises;  w  and  are  the  white 

r  j  t2 

noises  representing  the  thermal  noises  driving  the 
gimballed  seeker  dynamics;  and  w^  ,  w5,  and  are  the  white 
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noises 


driving  the  gimbalLed  seeker  glint  noises. 
Stationarity  is  assumed  in  the  initial  conditions  of  the 
glint  states.  The  random  constant  initial  conditions  for 
states  (10)  through  (15)  are  defined  in  Table  I.  and 
those  for  states  (21)  through  (26)  are  defined  in 

Table  II. 
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Ill, 


KALMAN  FILTER  DESIGN 


Introduction 

This  chapter  presents  the  Kalman  filter  design  for 
incorporating  the  measurements  from  the  truth  model.  As 
will  be  seen,  either  the  filter  dynamics  equations  or 
measurement  equations  are  nonlinear  in  this  application, 
depending  on  the  type  of  coordinate  frame  used.  For  this 
reason,  the  basic  Kalman  filter  is  not  applicable,  and 
either  a  higher  order  filter  or  an  approximate  Kalman 
filter,  such  as  the  extended  Kalman  filter,  must  be  used. 
The  extended  Kalman  filter  (EKF )  is  the  filter  chosen  for 
application  here,  for  several  reasons.  Primarily,  the 
first  order  linearization  in  the  EKF  formulation  has  been 
shown  to  be  a  good  approximation  to  many  nonlinear 
problems  (Ref  19:42).  Also,  the  EKF  has  been  applied 
successfully  in  previous  studies  similar  to  this 
work  (Refs  3 ; 5 ;  14 ; 17 ; 25 ) .  Finally,  the  EKF  gain  and 
covariance  propagation  equations  have  the  same  form  as  the 
Kalman  filter  equations,  but  are  linearized  about  the 
current  state  estimate;  in  effect,  providing  sufficient 
accuracy  at  a  level  of  computational  complexity  consistent 
with  the  design  already  accomplished.  The  use  of 
higher  order  filters,  such  as  Gaussian  or  truncated 
second  order  filters,  would  achieve  somewhat  better 
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performance,  but  with  substantially  greater  computational 
loading  (Ref  19:  225  ). 

The  extended  Kalman  filter  does  involve  an 
approximation  to  the  actual  nonlinear  system,  however.  The 
accuracy  of  the  filter's  state  estimates  is  limited  by  how 
well  the  true  system  has  been  modelled.  Therefore,  as  much 
effort  as  possible  must  be  spent  on  developing  good  system 
models.  Since  the  EKF  gains  and  estimation  error 
covariance  matrices  depend  on  the  time  history  of  the  state 
estimates,  the  actual  filter  performance  must  be  verified 
by  a  Monte  Carlo  analysis.  A  Monte  Carlo  simulation  is  the 
method  employed  in  this  tnesis  for  examining  the  EKF's 
performance.  This  simulation  was  facilitated  by  an 
available  software  package  (Ref  20). 

The  EKF  equations  are  not  derived  here,  but  good 
references  for  the  derivations  are  (Refs  11  and  19).  The 
equations  are  given  and  explained  in  the  next  section. 

Filter  Equations 

The  EKF  equations  can  be  placed  in  these  categories: 
the  system  dynamics  and  measurement  equations  upon  which 
the  filter  is  based,  the  propagation  equations,  and  the 
update  equations.  The  filter  state  equation  can  be 
expressed  in  the  form 

x  ( t )  =  f[x(t),u(t),  t]  +  G(t)w(t)  (27) 

where 

x(t)  is  the  n-state  filter  vector 
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f_  [x_(  t ) ,  u  { t ) ,  t]  is  the  filter  dynamics  vector 

u_(t)  is  a  deterministic  forcing  function 

w(t)  is  a  zero-mean  white  Gaussian  noise 
process  independent  of  x( t0 ) ,  of 
strength  Q(t),  such  that 

£{w(  t)wT(  t+T  )  }  =  Q.(t)6(x)  (28) 

and  where  x(t  )  is  modelled  as  a  Gaussian  random  variable 
with  mean  xQ  and  covariance  PQ  .  Note  that  the  dynamic 
driving  noise  is  assumed  to  enter  in  a  linear  additive 
fashion  (Ref  17:53).  The  measurement  equations  can  be 
expressed  as 

l(ti}  =  >'  tiJ  +  Z;ti>  (29) 

where 

^(t^)  is  the  m-dimensional  measurement  vector 
v  ( t^  )  is  a  zero-mean  white  Gaussian  noise  sequence, 

independent  of  x(tQ)  and  w(t),  with  strength 
R  ( t^  )  such  that 

Etv(ti)vT(t:j)}  =  R(ti)6ij  (30) 

The  filter  state  propagation  equation  is 

x(t/tt)  =  f  [x(t/ti),u(t),t]  (31) 

where  the  notation  x(t/t^)  means  the  optimal  (filter) 
estimate  of  the  state,  x,  at  time,  t,  given  the  estimates 
up  to  and  including  time  t^.  The  covariance  propagation 
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equation  is 


P  (  t/tL  ) 


F[t;x(t/ti  )]p(  t/ti)  +  P(  t/ti  )FT[t;x(  t/ti  )] 

+  G(t)Q(t)GT(t)  (32  ) 


where  F[t;x(t/tj)]]  is  the  linearization  of  the  filter 
dynamics  vector  about  the  current  estimate  given  by 


_  „  A  »  ii  C  t )  ,t] 

FttjXtt/^)]*  - ox - 


x(t/ti) 


(  33  ) 


where  the  notation  =  denotes  "defined  to  be. "  The  initial 
conditions  of  eqs.  (31)  and  (32)  are  given  by 


x  (ti/ti )  =  x ( t i + )  (34  ) 

Pt^/t^  =  P(  ti+  )  (35  ) 


i.e.,  the  result  of  the  measurement  at  time  tif  where  t^+ 
denotes  the  time  t^  after  update. 

The  extended  Kalman  filter  gain,  K(tx),  is  defined  by 

K(tL)  =  P(  )HT  [ti;x(  )]  • 

{H  [tiJX  ( ti”  )3  P(  ti  -  )hT  [ti;X  ( ti  -  )]  +  R(  ti)  )' 1  (36  ) 


in  which  H  [t^  ;  x(tif]  is  the  linearization  of  h  [x(t^),tj 
given  by 


3h[x(ti)  ,tj 


3x 


x 


x(ti-) 


(37) 


and  t^*  denotes  the  time  t^  just  before  update.  The  update 
equations  are 


x <  fci  +  )  =  MtL-)  +  K C  -  h[x{  ti-  >,  tA]  }  (38) 

L(ti+)  =  ~  K_(  t i  >  H[ti;  x(  ti‘  )]  P (  1 1 '  )  (39) 


in  which  z^  is  the  realization  of  the  measurement  z^t^  ) 
given  in  eq.  (29).  Note  that  the  measurement  update 
provides  the  initial  conditions  for  the  following 
propagation  and  the  quantities  propagated  to  time  t-~  are 
the  values  which  are  then  updated. 

The  extended  Kalman  filter  equations  will  now  be 
applied  in  the  filter  design  used  for  this  thesis. 


EKF  Design 

The  primary  concern  now  is  to  achieve  a  practical  and 
workable  filter  design  for  analyzing  the  use  of  the  truth 
model  measurements  ^nd  dynamics  outputs.  A  filter  design 
in  which  all  the  states  are  completely  observable  is  also 
desirable  (Ref  18:43-6).  These  considerations  must  be 
taken  into  account  when  selecting  the  filter  states,  the 
filter  coordinate  frame,  and  the  initial  conditions  for  the 
filter . 

Realistically,  one  would  consider  an  air-to-ground, 
tactical  missile  to  be  driven  by  the  available  measurements 
from  all  onboard  sensors,  initialized  by  signals  from  the 
launching  aircraft.  In  the  case  of  the  dual-seeker  missile 
with  onboard  INS,  the  number  of  seeker  measurements  will 
vary,  depending  on  the  number  of  seekers  operating. 
However,  the  missile  guidance  will  always  be  receiving 
ownship  acceleration  and  orientation  information,  assuming 
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a  fail-safe  INS.  Since  the  emphasis  in  this  thesis  is  on 
comparing  simulated  guidance  performance  during  various 
seeker-dependent  scenarios,  the  filter  design  should 
emphasize  use  of  the  seeker  measurements .  Also,  the 
onboard  computer  memory  and  time  available  to  the  filter 
will  certainly  be  limited.  All  of  these  considerations  led 
to  the  following  EKF  design. 


The  filter  state 

vector  chosen  is  composed 

of  the 

three  position  states 

and 

three  velocity 

states 

of  the 

target  with  respect  to 

the 

missile  in  the 

missile 

frame . 

Accelerations  need 

not 

be  estimated 

since 

noisy 

measurements  of  acceleration  are  available  from  the  INS. 
The  time-correlated  lag  noises  and  biases  of  the  seeker 
models  are  not  estimated  in  consideration  of  the  realistic 
computer  resources  of  the  conceptual  missile  and  because 
their  estimation  would  not  contribute  significantly  to  this 
study.  The  filter  state  vector,  therefore,  is  given  as 


V 

X 

x2 

vx 

= 

y 

X- 

vy 

X5 

z 

_x6 

V. 

L-* 

where 


X 

is 

the 

component 

of 

the 

target 

position 

y 

is 

the 

Yin 

component 

of 

the 

target 

position 

z 

is 

the 

% 

component 

of 

the 

target 

pos i tion 

(40  ) 
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v.  is  the  component  of  target  velocity  along  the 
xm-axis 

v  is  the  component  of  target  velocity  along  the 
y  ym-axis 

vz  is  the  component  of  target  velocity  along  the 

2  -axis 
in 

The  state  vector  is  written  in  inertial  rectangular 
coordinates  because  the  filter  dynamics  equations  are 
linear  in  such  coordinates,  reducing  the  computational 
burden  during  integration  (Ref  20:83)  and  in  the  local 
vertical  (missile)  frame  because  previous  filter  studies 
have  shown  that  there  are  advantages  to  local  vertical 
frame  implementation  (Refs  3:5-13;  5:9;  17:1;  25:99). 

Also,  the  filter  dynamics  equations  for  tnis  application 
are  straightforward  when  written  in  the  missile  frame  since 
the  accelerations  in  that  frame  are  directly  available. 
This  filter  model  is  essentially  one  good,  potential  model 
that  will  accomplish  the  aim  intended  for  it  in  this 


thesis. 


The  linear  version  of  eq.  (27)  is  given  by 


x ( t )  =  F ( t ) x ( t )  +  B(t)u(t)  +  G(t)w(t) 
and  is  defined  for  this  model  to  be 
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in  which 


*x 

is 

the 

target  acceleration 

along 

the 

x^-axis 

from 

the 

truth  model 

is 

the 

target  acceleration 

along 

the 

ym-axis 

from 

the 

truth  model 

a. 

is 

the 

target  acceleration 

along 

the 

Zirj-axis 

from 

I* 

the 

truth  model 

wl ,  w2 ,  and  w3  are  the  zero-mean,  white  Gaussian 
noises  representing  the  uncertainties  in  the 
three  INS  channels.* 

It  should  be  noted  that,  given  the  linear  dynamics  of 
eq.  (42),  the  partial  derivatives  of  eq.  (33)  need  not  be 
evaluated  during  propagation,  greatly  decreasing 
integration  time. 

The  measurement  vector  is  6-dimensional  when  both 
seekers  are  tracking  and  is  given  by 


“*r 

V 

z. 

£s 

*3 

= 

Cg 

Z5 

\ 

K 

where 


(43  ) 


as  is  the  azimuth  angle  of  the  target  with  respect 
to  the  x^-axis  as  measured  by  the  strapdown 
seeker 


is  the  elevation  angle  of  the  target  with  respect 
to  the  x^-yjj  plane  as  measured  by  the  strapdown 
seeker 


*Note:  White  Gaussian  noise  has  been  shown  to  be  an 
adequate  model  for  short-term  accelerometer  errors  for  some 
purposes  (Ref  24:2-4), 
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a g  is  the  azimuth  angle  of  the  target  with  respect 

to  the  xm  -axis  as  measured  by  the  gimballed 
seeker 

£g  is  the  elevation  angle  of  the  target  with  respect 
to  the  xm-ym  plane  as  measured  by  the  gimballed 
seeker 

ag  is  the  rate  of  change  of  as  measured  by  the 

gimoalled  seeker 

eg  is  the  rate  of  change  of  as  measured  by  the 

gimballed  seeker  ' 

With  this  measurement  vector,  eg.  (29)  is  written  as 
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where 
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pi  c2  c; 
|c,  c5  c6 


is  the  orthogonal 


C7  c8  CSJ 
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transformation  matrix  from  the  missile  frame  to  the  body 
frame  defined  by  eq.  (1),  and  vl ,  v2  ,  . . . ,  vo  are  the 

discrete-time  measurement  uncertainties  defined  by 
eq.  (30).  The  ar ' muth  and  elevation  angles  expressed  as  a 
function  of  the  filter  states  are  straightforward  from 
their  definition  in  eqs.  (16)  and  (17).  The  angle  l  ites  as 
a  function  of  the  filter  states  are  found  by  taking  the 
first  derivatives  of  their  corresponding  angle  expressions 
as  functions  of  time. 

As  is  easily  seen  in  eq.  (44),  the  measurement  vector 
defined  by  eq.  (43)  is  a  highly  nonlinear  function  of  the 
filter  states.  For  this  reason,  the  partial  derivatives  of 
Jb  ^  x  ( t  i  ) ,  1 1 J  as  defined  by  eq.  (44)  must  be  calculated  and 
are  evaluated  at  each  update  time.  The  derivation  of  it 
and  the  resulting  measurement  matrix  H£tx  ;x(t  -x  ~  )j  are  given 
in  Appendix  B. 


EKF  Noise  Strengths  and  Initial  Conditions 

Again,  the  strengths  of  the  dynamic  driving  noises  wJf 
w2,  and  w3  in  eq.  (42)  represent  the  uncertainties  in  the 
accelerations  from  the  INS.  These  strengths,  in  the 
notation  of  eq.  (28),  are  given  by 


Q(t) 


Qi  0  0 

C  Q2  0 
0  0  q3 


(  45  ) 


The  effect  of  the  noise  strengths  Q^,  Q, ,  and  Q3  is  seen  in 
the  covariance  propagation  eq.  (32).  With  zero  Q(t),  the 
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filter's  uncertainty  in  its  estimate  represented  by 
P(t/t.)  will  approach  zero  as  t  approaches  infinity.  In 
order  to  prevent  P_(t/t^)  from  going  to  zero  such  that  the 
filter  will  essentially  ignore  the  measurements  z_(t^),  Q(t) 
must  be  kept  nonzero. 

Realistically,  g(t)  would  increase  drastically  if  an 
accelerometer  failure  occurs.  Neglecting  such  failures, 
the  expected  error  in  a  given  accelerometer  is  relatively 
constant  and  a  function  of  the  quality  of  instrument  used. 
Also,  the  error  can  be  assumed  to  be  much  the  same  for 
three  accelerometers  mounted  on  the  same  platform. 
Recognizing  that  the  INS  instruments  would  be  of  rather 
poor  quality,  the  strength  of  each  of  the  noises  wx  ,  w2 , 
and  w3  was  chosen  nominally  as  1  ft2/sec3.  This  value  can 
be  changed  for  filter  tuning  as  discussed  in  the  next 
chapter. 

The  strengths  of  the  measurement  noise  vector 

v(t^)  are  also  a  major  consideration  in  filter  tuning. 

Realistically,  the  only  way  to  gain  a  priori  knowledge  of 

the  noise  strength  matrix  R(t^)  as  defined  in  eq.  (30)  is 

to  consider  the  truth  model  noise  entering  each 

measurement.  Since  all  of  the  truth  states  are  not 

included  in  the  filter  model,  R(t.)  must  include 

-  1 

pseudonoise  to  account  for  the  neglected  states.  A  'mi-.! 
that  all  measurements  are  independent,  R(t^)  is  l 

matrix  given  by 
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R(  ti 


0  0  0  0  0 

o  r2  0  0  0  0 

0  0  R3  0  0  0 

0  0  0  R  0  0 

It 

0  0  0  0  Rs  0 

0  0  0  0  0  Rc 

D 


(46  ) 


Since  the  measurements  corresponding  to  the  azimuth  and 
elevation  channels  of  each  seeker  are  generated  in  an 
equivalent  manner  in  the  truth  model,  it  can  be  assumed 
that  R.  =  R,  ,  R,  =  R  .  and  R  _  =  R..  Initial  choices  for 
the  noise  strengths  are  left  for  discussion  in  the  filter 
tuning  chapter. 

As  mentioned  in  the  filter  equations  section,  x(tQ)  is 

A 

a  Gaussian  random  variable  with  mean  xQ  and  covariance  PQ. 

The  mean  is  conceptually  the  true  initial  conditions  from 

the  truth  model.  The  covariance  PQ  defines  the  Gaussian 

distribution  about  the  true  initial  conditions  that 

represents  the  initial  state  uncertainty.  Realistically, 

the  filter  would  be  initialized  by  the  launching  aircraft' s 

INS  just  before  launch.  Therefore,  P  is  a  measure  of  the 

—0 

confidence  given  to  the  aircraft  INS.  Considering 
magnitudes  of  the  launch  range  of  20,000  ft  and  initial 
missile  velocity  of  843.9  ft/sec,  P  was  chosen  to  be 
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representing  an  uncertainty  in  the  INS  at  launch  of 
about  1%.  The  initial  covariances  of  the  filter  states 
provide  reasonable  initial  conditions  for  the  filter 
covariance  matrix  P(t)  which  is  propagated  to  this  first 
update  time  via  eq.  (32).  The  initial  P(t)  is  a  major 

filter  tuning  consideration.  It  is  discussed  further  in 
the  following  chapter  which  presents  the  implementation  of 
the  model  designs  accomplished  in  the  past  two  chapters. 
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IV.  MODEL  IMPLEMENTATION/METHOD  OF  EVALUATION 


Introduction 

The  system  truth  model  developed  in  Chapter  II  and  the 
extended  Kalman  filter  developed  in  Chapter  III  are  designs 
which  lend  themselves  readily  to  digital  computer 
implementation.  This  chapter  presents  the  techniques  for 
accomplishing  this  implementation  with  the  goal  of 
achieving  tnc  best  filter  performance  possible.  Following 
the  implementation  considerations  is  a  discussion  of  the 
way  in  which  the  filter  will  be  used  to  evaluate  the  four 
measurement  policies. 

Software  Implementation 

The  purpose  of  the  preceding  Kalman  filter  development 
was  to  implement  a  practical  filter  design  and  compare  its 
performance  against  the  truth  model  in  a  Monte  Carlo  study 
of  the  measurement  policies  given  in  Chapter  I.  The 
software  package  SOFE  developed  by  Mr.  S.  H.  Musick  of  the 
Air  Force  Avionics  Laboratory  (Ref  20 ),  provided  the 
skeletal  structure  for  this  iimplementation  and  Monte  Carlo 
analysis.  A  postprocessor,  SOFEPL,  also  developed  by  the 
Avionics  Laboratory  (Ref  21),  provided  the  capability  for 
producing  Calcomp  plots  of  the  the  results.  A  sample  of 
the  plot  type  chosen  for  use  in  this  thesis,  shown  in 
Figure  4-1,  presents  the  sample  statistics  taken  from  20 
runs  of  the  filter.  This  number  of  runs  was  chosen  for 
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Lgure  4-1.  Sample  SOFEPL  Plot 


evaluating  the  filter's  performance  because  previous 
studies  have  shown  that  the  statistics  are  representative 
over  a  20  run  ensemble  (Refs  5:76;  14:5-7;  25:65). 

The  plot  type  chosen  gives  the  mean  error  of  the 
filter  state  estimate  minus  the  truth  state,  the  envelope 
of  the  mean  plus  and  minus  the  standard  deviation  of  the 
actual  error,  and  the  envelope  of  plus  and  minus  the  square 
root  of  the  filter-computed  error  variance  corresponding  to 
the  state.  From  such  a  plot,  one  may  evaluate  the  filter's 
performance  by  observing  whether  the  error  is  zero-mean  and 
whether  the  filter's  variance  corresponds  well  to  the 
actual  system's  mean-squared  value.  The  particular  plot 
shown  displays  good  filter  performance  since  the  mean  and 
mean-squared  value  are  well  within  the  filter's  variance 
and  because  the  mean  error  is  approximately  zero  over  the 
ensemble  of  runs.  This  type  of  plot  will  be  used  for 
filter  tuning  and  performance  evaluation  as  will  be  seen 
following  the  discussion  of  the  rest  of  the  software 
implementation  considerations. 

A  major  factor  in  implementing  the  truth  model 
simulation  and  the  extended  Kalman  filter  design  is  the 
solution  of  the  differential  equations  of  the  truth 
state,  filter  state,  and  filter  covariance,  eqs.  (26), 
(32),  and  (42).  The  integration  of  the  homogeneous  parts 
of  these  equations  is  accomplished  through  the  use  of  a 
fifth  order  numerical  integrator  supplied  in  SOFE.  The 
effect  of  the  driving  noise  in  the  filter  dynamics 
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differential  eq.  (42)  is  taken  into  account  by  the 
term  "G( t )Q( t )G^( t ) "  in  the  filter  covariance  differential 
eq.  (32).  The  effect  of  the  truth  model  noise  is  taken 
into  account  by  adding  discrete-time  samples  of  the 
equivalent  white  Gaussian  discrete-time  stochastic  process 
for  the  truth  model,  at  appropriate  intervals  during  the 
integration  cycle. 

The  eight  truth  states  which  are  driven  by  white 
Gaussian  noises  are  all  first  order  lag  models.  Assuming 
independent  models,  the  equivalent  d iscrete-time  noise 
strengths,  Q^(t^)'s,  are  the  solutions  to 

Qd(t.)  ri+1  <t(ti  +  l,T)GCT)Q(T)GT(T)$TCti+1,T)  dt  (48) 

J  ti 

in  which  4(t^+l,x)  is  the  element  of  the  system  state 
transition  matrix  corresponding  to  the  given  state 
(Ref  18:171).  For  a  first  order  Markov  process ,  <t>  ( t^  +  x )  is 
given  by 

Cti  +  1  ,t) 

<Kti+1,'0  -  e~  t  (49) 

in  which  i  is  the  time  constant  of  the  model.  Therefore, 
the  solution  to  eq.  (48)  is 

QdUi)  =  j^1+l  Q  e'2(ti+1'T)/T  d'f 

-  ?  [l-e'2(ti+1'ti)/T]  ,  0.f 

L  J  ( 50  ) 

where  o  is  the  standard  deviation  of  the  state  viewed  as 
the  output  of  the  first  order  lag  (Ref  18:185).  In  SOFE, 
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each  truth  state  are 


noise  samples  of  strength  Q  for 

d 

added  at  one  prespecified  interval.  This  interval  must  be 
smaller  than  the  shortest  time  constant  in  eq.  (26)  by  a 
factor  of  at  least  one-half  in  order  to  satisfy  the  Shannon 
sampling  theorem  (Ref  16:295).  The  period  for  adding  the 
discrete-time  noise  samples  was  chosen  to  be  one-fifth  the 
shortest  system  time  constant,  which  is  0.075  sec  in  the 
gimbal  dynamics  model.  The  factor  of  one-fifth  satisfies 
the  Shannon  sampling  criterion  while  minimizing  the 
computer  burden  inherent  in  interrupting  the  integration 
cycle  to  add  the  noise  samples.  With  truth  model  and 
filter  propagations  thus  accomplished,  the  remaining 
implementation  consideration  is  filter  update. 

The  actual  filter  update  formulation  used  in  SOFE  is 
the  sequential  scalar-measurement,  square-root  form 
developed  by  Carlson.  This  formulation  has  implementation 
advantages  in  computational  speed  and  accuracy  which  need 
not  be  discussed  in  detail  here  but  can  be  found,  along 
with  the  equations,  in  Refs  18:385  and  20:26-32.  The 
importance  of  the  update  formulation  used  in  SOFE  is  that 
measurements  are  incorporated  sequentially  and  any 
particular  measurement  can  thus  be  readily  suppressed. 
Provision  was  made  in  the  software  implementation  for  this 
thesis  to  allow  any  combinations  of  strapdown  seeker  angle 
measurements,  gimbalied  seeker  angle  measurements,  and 
gimballed  seeker  angle-rate  measurements  over  any  time 
interval  during  the  simulation  run.  This  method  of 
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incorporating  the  measurements  provided  the  flexibility 
needed  for  tuning  the  filter  and  performing  the  desired 
analyses.  with  the  software  implementation  of  the  truth 
model  and  EKF  design  thus  developed,  filter  tuning  can  now 
be  discussed. 

Filter  Tuning 

The  intent  of  filter  tuning  is  to  achieve  the  best 

possible  filter  performance  in  the  realistic  truth  model 

environment,  given  the  modelling  approximations  employed  in 

the  filter  design.  In  a  practical  sense,  the  filter 

parameters  are  adjusted  to  allow  it  to  estimate  its  state 

vector  as  accurately  as  possible.  As  mentioned  previously, 

tuning  is  accomplished  by  varying  the  lilter  dynamic 

driving  noise  strength,  measurement  noise  strength,  and 

initial  covariance  matrix.  To  begin  the  tuning  process, 

reasonable  first  choices  for  Q(t),  I'.(t)  and  P(t  )  must  be 

—  —  —  o 

selected.  An  initial  value  of  Q(t>,  chosen  in  Chapter  II X, 

is  1  ft/'sec3  for  all  three  diagonal  elements.  Initial 

values  for  ,  R3  ,  and  Rb  were  selected  by  running  the 

filter  wi*-h  all  six  measurements  over  the  entire  run  and 

examining  the  measurement  residual  r(t.)  defined  as 

—  1 

~  h[x(ti'  ),  tj  (51) 

for  all  the  times  t^.  The  residual  vector  defines  the 
error  between  the  true  measurements  and  what  the  filter 
predicts  the  measurement  to  be.  This  residual  vector  is 
multiplied  by  the  filter  gain  K(t^)  to  update  the  filter 
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state  vector  as  seen  in  eq.  (38). 

By  examining  the  resulting  residual  vector,  one  gains 
insight  into  how  strongly  the  filter  should  be  weighting 
the  measurements.  One  approach  is  to  consider  the  maximum 
residual  standard  deviation  to  be  a  2  or  3o  value  for  R(t). 
Using  this  methodology,  the  first  values  for  R ( t )  were 
chosen  to  be  0.00125  rad-1  .  Both  Q(t)  and  R ( t )  were  held 
constant  over  the  entire  missile  flight,  because  the 
missile  dynamics  are  relatively  constant  throughout  the 
flight  and  because  the  dominant  truth  model  noises  are 
range -independent. 

A  reasonable  initial  value  for  P ( t ) ,  as  slated  in 
Chapter  III,  is  the  covariance  matrix  of  the  filter  initial 
conditions.  Therefore,  P(0)  was  initially  chosen  to  be 


P(0)  = 


10,000 

0 

0 

0 

0 
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0  0  0  0 

10  0  0  0 
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10 
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corresponding  to  ^  defined  in  eq.  (47).  With  these  values 
of  Q,  R,  and  P(0),  plots  of  the  six  filter  states'  errors 
over  20  runs  with  both  seekers  operative  throughout  are 
found  in  Figures  C-l  through  C-6.  As  seen  in  che  plots, 
the  error  standard  deviation  is  well  bounded  by  the  filter 
covariance  envelope  for  most  of  the  states.  However,  the 
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filter  initial  conditions  are  not  zero-mean  over  the  20 


runs  for  all  of  the  states. 

The  reason  for  the  non-zero-mean  initial  conditions  is 
the  quality  cf  the  random  number  generator  used  in  SOFE. 
To  demonstrate  this,  a  50-run  study  was  made,  and  the  plot 
for  the  vx  state  is  given  in  Figure  C-7.  i n  comparison  to 
Figure  C-2,  the  mean  of  the  initial  conditions  for  50  runs 
is  much  closer  to  zero.  As  a  further  demonstration,  the 
seed  for  the  random  nurder  generator  was  changed  for  20 
runs,  and  the  mean  of  the  initial  conditions  of  the  same 
state  vx  is  seen  to  change  signs  in  Figure  C-8.  Although 
the  initial  conditions  are  not  zero-mean  over  20  runs,  this 
is  not  adequate  motivation  for  increasing  the  number  of 
runs  of  this  study.  The  statistics  are  still 
representative  at  steady-state,  and  the  non-zero-mean 
initial  conditions  can  be  compensated  by  increasing  P(0)  as 
demonstrated  in  Figures  C-7  and  C-8.  For  these  runs,  the 
square  root  of  each  element  of  P ( 0 )  was  chosen  to  be  150% 
of  the  standard  deviations  of  the  filter  initial 
conditions . 

The  increased  value  of  P(0)  was  used  for  the  rest  of 
the  tuning  runs  and  for  the  result  runs.  Having  a  large 
enough  initial  covariance  for  the  filter  is  desirable  to 
l  event  the  filter  from  believing  the  initial  filter 
estimates  are  better  than  t.oey  truly  are.  It  will  be  seen 
that  P(0 )  thus  chosen  is  adequate  for  the  rest  of  the  runs 
made  for  this  study. 


to  be  made  for  filuer 


The  remaining  considerations 
tuning  are  the  values  of  Q  and  R.  Varying  £  by  factors  of 
10  and  1/10  revealed  that  the  filter  is  fairly  insensitive 
to  the  dynamic  driving  noise  strength,  therefore,  further 
tuning  was  done  by  varying  R.  The  most  straightforward  way 
to  find  the  best  values  for  RA  ,  R3  ,  and  R5  is  to  tune 
separately  for  each  set  of  measurements.  Therefore,  the 
filter  was  run  with  just  the  strapdown  measurements 
initially,  then  just  the  gimbalied  angle  measurements,  and 
finally  just  the  gimbalied  angle-rate  measurements, 
selectively  choosing  a  good  value  for  the  measurement  noise 
for  each.  Each  set  of  runs  was  begun  with  the  value  of 
R=0. 00125  rad""  ,  and  this  R  was  adjusted  up  or  down  t.o 
improve  the  filter  performance. 

The  initial  plots  for  the  strapdown  seeker  are  found 
in  Figures  C-9  through  C-14.  The  filter  is  seen  to  perform 

well  except  in  the  z-position  state.  Upon  varying  R3  ,  it 

2 

was  found  that  increasing  R4  to  0.0028  rad  resulted  in  the 
improved  performance  for  that  state  seen  in  Figure  C-15. 
Thus,  this  value  was  selected  for  R1  (and  R2 ) . 

The  initial  plots  for  the  gimbalied  seeker,  angle 
measurements  only,  are  found  in  Figures  C-16  through  C-21. 
The  filter  is  seen  to  perform  extremely  well  in  all  states, 
therefore  R3  was  decreased  to  examine  the  filter's 

weighting  of  these  measurements.  Decreasing  R^  to 

2 

0.000556  rad  increased  the  transient  behavior  of  the 
y-position  state,  as  seen  in  Figure  C -22.  The  filter 
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errors  are  still  zero-mean  and  well-bounded  for  this  state 


and  all  other  states  so  this  value  for  R3  would  seem  to  be 

appropriate,  since  the  lowest  possible  value  is  desirable. 

Decreasing  R3  further  would  increase  the  transient  behavior 

in  the  y-position  estimate  even  more  and  probably  not  gain 

much  in  filter  performance.  Therefore,  the  value  for  R3 

2 

(and  R,,  )  was  selected  to  be  0.000556  rad  . 

The  initial  plots  for  the  gimballed  seeker,  angle-rate 

measurements  only,  are  found  in  Figures  C-23  through  C-28. 

The  filter  is  seen  to  diverge  in  x  and  z,  gradually  at 

first,  but  with  an  increasing  slope  towards  the  end  of  the 

trajectory.  This  divergent  behavior  could  be  due  to  the 

lack  of  observability  with  the  angle-rate  measurements  only 

or  to  the  over-weighting  of  noisy  measurements.  Rs  was 

increased  to  examine  the  latter  possibility.  With  Rs  at  a 

2 

value  of  0.0078  rad  ,  further  increases  do  not 
significantly  improve  filter  performance.  The  plots  for 
R3=0.0078  rad'  are  shown  in  Figures  C-29  through  C-34. 
TThe  errors  are  bounded  by  the  filter's  covariance  for  the 

length  of  the  run  but  still  seem  to  be  divergent  at  the 

2 

end.  Increasing  Rs  to  0.01125  rad  did  not  improve  the 
filter's  performance  significantly  in  the  two  sensitive 

states,  as  seen  in  Figures  C-35  and  C-36.  Therefore, 

2 

R5  (and  Rb  )  was  selected  to  be  0.0078  rad  ,  and  the 
divergence  can  be  attributed  to  an  observability  problem 
with  these  measurements. 

With  this  coarse  filter  tuning  thus  accomplished,  the 
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resulting  measurement  noise  covariance  is  given  by 


0.0028  00  000 

0  0.0028  0  000 

R(t)=R=  0  0  0.000556  000  (53) 

000  0.000556  0  0 

000  C  0.0078  0 

0  0  0  0  0  0 . 00  78_ 

Again,  the  state  noise  strength  matrix  was  chosen  to  be 

"1.0  0  0  " 

2(t)  2  =  0  1.0  0  (54  ) 

_0  0  1.0_ 

and  the  initial  state  covariance  was  chosen  to  be 

“22,500  0  0  0  0  0  “ 

0  225  0  0  0  0 

P  (  0  )  =  0  0  22,500  0  0  0  (55  ) 

0  0  0  225  0  0 

00  00  22,500  0 

_  0  0  0  0  0  225J 

These  values  of  Q,  R,  and  £(0)  should  give  adequate  filter 
performance  to  evaluate  the  four  measurement  policies. 

Method  of  Evaluation 

As  stated  in  the  introductory  chapter,  the  goal  of 
this  thesis  is  to  present  a  reasonable  method  for,  and  the 
results  of,  evaluating  the  dual-seeker  concept  for  the 
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proposed  missile.  The  truth  model  and  EKF  design,  which 
were  implemented  as  described  in  this  chapter,  provide  the 
means  for  accomplishing  this  evaluation.  The  SOFEPL  plots, 
discussed  in  the  previous  section,  provide  the  means  for 
presenting  the  evaluation  graphically.  The  SOFEPI,  program 
outputs  summary  statistics  of  each  plot  so  that  numerical 
results  are  also  available.  These  statistics  for  the 


results 

are  „ 

resented  in 

tabular  form 

in  the 

next 

chapter . 

The 

statistics  available 

from 

the  SOFEPL 

output  are 

the  minimum. 

maximum. 

and 

time  av 

erage 

of 

each 

curve 

plotted . 

Of 

the  five 

curves 

on  the 

plots 

used 

for 

this 

thes i s , 

the 

statistics 

for 

the  mean 

error 

and 

the 

mean 

error  plus  or  minus  the  standard  deviation  of  the  mean 
error  provide  the  best  indication  of  how  the  filter  is 
performing.  For  this  reason,  the  following  statistics  will 
be  used  to  evaluate  the  filter's  performance  for  each 
measurement  policy: 

1}  the  time  average  of  the  mean  error 

2)  the  magnitude  of  the  maximum  mean  error 

3)  the  time  average  of  the  standard  deviation 
of  the  mean  error 

4)  the  magnitude  of  the  maximum  of  the  mean 
error  plus  or  minus  one  standard  deviation 

Because  they  include  the  statistics  over  the  whole 

trajectory  the  time  averages  in  1)  and  3)  above  are  the 

best  indication  of  overall  filter  performance.  The 

maximurns  in  2)  and  4)  indicate  the  most  serious 

instantaneous  error  committed  by  the  filter.  As  will  be 
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seen  in  the  results,  however,  the  random  initial  conditions 
often  biased  the  time  average  of  the  mean  error  and  both 
maximum  values.  Therefore,  the  comparisons  are 
concentrated  on  the  time  average  of  the  standard  deviation. 
These  statistics  will  be  used  in  conjunction  with  the  plots 
to  compare  the  filter's  performance  for  each  measurement 
policy. 

To  simplify  references  to  the  measurement  policies 
described  in  Chapter  I,  the  numbers  given  in  Table  III  will 
be  used . 

Table  III 

Measurement  Policies 


Policy 

Description 

1 

Both  seekers  operative  throughout  flight 

2 

Strapdown  seeker  only  until  midflight, 
loss  of  strapdown  and  switch  co  gimballed 
seeker  at  midflight 

3 

Both  seekers  operative  initially,  loss 
of  strapdown  seeker  at  midflight 

4 

Strapdown  seeker  operating  alone  initial¬ 
ly,  gimballed  seeker  on  at  midflight 

The  midflight  transition  point  was  chosen  to  be  16  sec, 
because  the  semi-active  laser  seeder  implemented  in  the 
LLLGB  simulation  acquired  the  target  at  that  point  in  the 
trajectory.  The  missi le-to-target  range  is  approximately 
8400  ft  at  the  transition  point.  To  enable  direct 
comparisons  between  dissimilar  policies,  16  sec  is  used  as 


71 


the  switching  point  both  when  the  strapdown  seeker  loses 
track  and  when  the  gimballed  seeker  doesn't  acquire  the 
target  until  midflight. 

The  overall  philosophy  of  performance  evaluation  can 
now  be  discussed.  The  filter  performance  will  be  evaluated 
both  by  a  visual  examination  of  the  results'  plots  and  by  a 
numerical  comparison  of  the  statistics  of  the  plots.  The 
plots  graphically  portray  the  filter's  performance  and 
confidence  at  the  end  of  the  trajectory  and  the  confidence 
gained  (or  lost)  during  the  seeker  switching  points.  Since 
the  filter's  performance  is  generally  very  good  in  the  end 
conditions  for  all  policies,  no  attempt  will  be  made  to 
measure  numerically  these  results  from  the  graphs. 
Instead,  direct  visual  inspections  provided  adequate 
comparisons  between  policies  in  the  end  conditions.  The 
tabulated  statistics,  especially  the  time  average 
statistics,  again,  provided  the  best  indication  of  filter 
performance  over  the  whole  trajectory.  The  statistics  will 
be  used  to  compare  the  overall  performance  in  terms  of 
maximum  absolute  values  and  percentage  differences.  Thus, 
it  is  important  to  consider  both  methods  because  each 
provides  some  information  that  the  other  does  not. 

Although  the  end  conditions  give  the  best  indication 
of  the  filter's  estimation  at  the  impact  point,  better 
performance  is  desirable  early  in  the  trajectory  because  of 
energy  considerations.  If  the  filter's  estimates  converge 
very  late  in  the  trajectory,  the  missile  may  not  have 
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enough  energy  or  the  aerodynamic  capability  to  correct  for 
early  errors  and  steer  to  the  target.  Therefore,  the 
filter's  performance  at  the  end  of  the  trajectory  and  its 
performance  overall  will  both  be  considered.  When  the 
filter's  performance  is  described  from  the  plots,  "good" 
filter  performance  is  characterized  by  the  mean  errors 
converging  to  essentially  zero  and  by  convergence  of  the 
standard  deviations  of  the  mean  errors  at  the  end  ( in  the 
last  several  seconds)  of  the  trajectory  to  small  values  in 
comparison  to  the  initial  errors.  "Poorer"  filter 
performance  is  characterized  by  non -zero-mean  errors  and 
larger  standard  deviations  in  the  end  conditions. 
Conceptually,  the  numerical  results  provided  by  the  plot 
statistics  can  be  thought  of  in  terms  of  "error 
probability, "  If  the  average  error  and  standard  deviation 
(or,  more  exactly,  the  RMS  value  of  the  error)  are  within 
the  kill  radius  of  the  missile  warhead,  the  missile  can  be 
considered  to  have  "hit"  the  target.  Since  no  specific 
missile  is  considered  in  this  thesis,  an  exact  kill  radius 
is  not  available.  Therefore,  filter  performance 
comparisons  derived  from  the  plot  statistics  are  described 
in  terms  of  "percent  improvement, "  with  the  realization 
that  differences  in  small  values  may  not  be  significant. 

One  final  consideration  in  evaluating  the  filter's 
performance  is,  which  filter  states  should  be  considered. 
In  general,  there  is  a  direct  correspondence  between  a 
velocity  state  and  its  respective  position  state.  This 
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correspondence  is  evident  in  the  tuning  plots  already 
discussed,  and  is  due  to  the  coupling  between  the  position 
and  velocity  states  seen  in  the  filter  dynamics  equation, 
eq.  (42).  Because  a  comparison  between  velocity  states 
does  not  provide  any  more  information  than  a  comparison 
between  the  corresponding  position  states,  and  vice  versa, 
only  the  position  states  will  be  compared  directly  in  the 
results.  The  complete  set  of  plots  for  each  measurement 
policy  is  included  in  the  results  for  completeness, 
however. 

Because  of  the  lack  of  observability  in  the  x-channel, 
the  filter  comparisons  will  not  include  consideration  of 
the  x-position  (or  velocity)  state.  As  seen  in 
Figures  C-9,  C-10,  C-16,  and  C-17,  for  example,  the 
filter's  covariance  indicates  that  the  filter  is  not 
gaining  any  information  about  the  x-channel  until  the  very 
end  of  the  flight.  Although  the  errors  are  zero-mean  for 
the  x-channel  in  most  of  the  plots,  discussion  of  the 
x-channel  for  each  of  the  policies  would  provide  nc 
meaningful  comparisons  between  the  policies.  As  seen  in 
Figure  2-2,  the  lack  of  observability  in  x  is  due  to  the 
fact  that  the  missi le-to-target  range  vector  is  almost 
entirely  along  the  x-direction  at  any  point  in  the  flight. 
Angular  variations  off  this  vector,  such  as  provided  by  the 
two  seekers,  give  little  information  about  changes  in  x  or 
vx  .  The  increase  in  observability  in  x  at  the  end  of  the 
trajectory  is  due  to  the  rotation  of  the  range  vector  away 


from  the  x-direction  such  that  it  has  significant 
components  in  all  three  directions.  The  overall  lack  of 
observability  in  x  (essentially  range  for  this 

trajectory)  demonstrates  the  classic  problem  of  angle-only 
range  estimation,  which  has  been  studied  extensively 
(Refs  1;9; 15 ;22 ; 23  ) . 

Thus,  comparisons  between  measurement  policies  in  the 
results  to  follow  will  be  made  on  the  basis  of  the 
y-position  and  z-position  states.  As  seen  in  their  plots 
already  discussed,  these  states  are  observable  throughout 
the  trajectory.  For  the  filter  formulation  implemented  for 
this  study,  comparisons  of  the  filter's  performance  in  the 
y  and  z  states  (filter  states  x3  and  xs  )  provide  a 
realistic  basis  for  performance  evaluation. 


V.  RESULTS 


Introduction 

This  chapter  is  a  discussion  of  the  results  of  running 
the  EKF  designed  in  Chapter  III  against  the  truth  model  of 
Chapter  II.  Four  sets  of  plots  for  the  measurement 
policies  listed  in  Table  III  in  the  previous  chapter 

provide  the  basis  for  evaluating  the  filter  design  in 
general  and  for  comparing  the  filter's  performance  for  each 
policy.  These  plots  are  found  in  Appendix  D.  The  summary 
statistics  of  the  plots  for  states  y  and  z  are  found  in 
Table  IV.  As  described  in  the  previous  chapter.  the 
statistics  given  are  the  time  average  and  maximum  value  of 
the  mea"  error,  the  time  average  of  the  standard  deviation 
of  the  mean  error,  and  the  maximum  of  the  mean  error  plus 
or  minu-  one  standard  deviation.  The  discussion  of  the 
results  begins  with  an  evaluation  of  the  general 

performance  of  the  filter  over  all  the  runs  done  for  this 
study. 


General  Performance  of  the  Filter 
As  seen  in  the  tuning  plots 
results  plots  of  Appendix  D,  the 
except  in  the  case  of  angle-rate 
the  observability  problem  (Figures 
tuning  accomplished  for  this 
well-bounded  filter  performance. 


of  Appendix  C  and  in  the 
EKF  design  performs  well 
measurements  only,  due  to 
C-23  through  C-36).  The 
case  gave  reasonably 
Also,  the  angle-rate 
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Table  IV.  Statistics  of  Plots  for 


*These  high  values  are  due  to  the  random  initial  conditions  for  the  filter 


measurements  are  not  used  alone,  but  in  conjunction  with 
the  angle  measurements  from  the  gimballed  seeker  truth 
model.  The  angle  measurements  are  weighted  more  heavily 
(see  eq.  (53))  because  of  tuning  considerations,  and  will, 
in  effect  "smooth"  the  poor  performance  due  to  the 
angle-rate  measurements.  The  angle-rate  measurements  do 
provide  some  observability  of  the  velocity  states  (see 
eq.  (44)),  which  is  a  benefit  of  the  gimballed  seeker  model 
over  the  strapdown  seeker  model  and  may  contribute  to  the 
performance  benefits  of  the  gimballed  seeker  to  be  seen. 

The  general  lack  of  observability  in  the  x-channel  no 
matter  what  measurement  policy  is  employed,  has  already 
been  discussed  and  is  not  unique  to  the  filter  design  of 
this  thesis  (Ref  23).  No  attempt  will  be  made  here  to 
compare  this  filter  design  to  other  angle-only  range 
estimation  algorithms.  Although  the  EKF  filter  design 
employed  in  this  thesis  does  not  estimate  range  states 
(x-pcsition  and  velocity)  well,  the  observability  of  the  y 
and  z  states  does  enable  this  filter  design  to  be  used  for 
the  desired  analyses.  This  observability  in  y  and  z  can 
easily  be  seen  in  the  plots  as  the  immediate  convergence  of 
the  filter  covariances  from  the  initial  uncertainties.  The 
y  and  z  states  are  observable  because,  given  the  relatively 
small  initial  uncertainty  in  x,  the  angular  changes 
indicated  by  the  measurement  vector  reflect  position  and 
velocity  changes  perpendicular  to  the  range  vector,  or 
changes  in  y-  and  z-pcsitions  and  velocities.  The 
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observability  in  z  decreases  somewhat  at  the  end  of  the 
trajectory  because  the  range  vector  rotates  and  gains  a 
significant  component  along  the  2-axis  (See  Figure  2-2). 

In  general,  the  y  and  z  state  estimates  converge  well  for 
all  cases  and  are  zero-mean  at  the  end  conditions. 

As  indicated  by  the  statistics  of  Table  IV,  the 

overall  filter  performance  for  states  y  and  z  is  quite  good 
for  all  cases.  Note  that  six  values  in  the  table  are  high 
due  to  the  random  initial  conditions'  not  being  zero-mean. 

Inspection  of  the  plots  for  these  cases  show  that  the 

initial  conditions  are  the  maximum  values.  Though  only  the 
high  maximum  values  are  noted  in  Table  IV,  the  average  mean 
errors  for  these  policies  are  necessarily  increased  by  the 
biased  initial  conditions.  As  seen  in  the  plots,  the 

standard  deviations  of  the  initial  conditions  are  much 

closer  to  the  values  indicated  by  the  P  matrix  <eq.  (47)). 

This  fact  alone  motivates  consideration  of  the  average 
standard  deviations  as  the  most-representative  statistics. 

In  addition,  even  with  the  biasing  on  the  average  mean 
errors  for  some  policies,  all  the  average  mean  errors  are 
relatively  small  (less  than  10  ft)  with  respect  to  missile 
kill  radii.  Therefore,  the  best  indication  of  filter 
performance  from  the  statistics  is  provided  by  the  average 
standard  deviations.  Note  that  the  average  standard 

deviation  statistics  are  consistent  between  the  two  states, 
y  and  z,  for  corresponding  policies,  which  provides 
additional  confidence  in  the  correctness  of  the  filter  j 
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design.  These  statistics  will  now  be  used  in  conjunction 
with  the  plots  to  compare  the  filter's  performance  for  each 
measurement  policy. 

Measurement  Policy  Comparisons 

Overall .  In  general,  one  can  expect  bettee  filter 
performance  the  greater  the  number  of  measurements 
available  at  each  sample  time.  Given  proper  filter 
modelling  and  tuning,  the  filter  will  weight  and 
incorporate  each  measurement  made  available  to  it.  The 
basic  Kalman  filter  is  the  optimal  estimator  (Ref  18:206): 
one  is  guaranteed  better  filter  performance  (in  a  minimum 
variance  sense)  the  more  measurements  available,  given 
proper  modelling  and  tuning.  Since  the  extended  Kalman 
filter  formulation  is  a  linearization  technique,  it  is  not 
necessarily  "optimal"  (Ref  19:39-42).  As  has  been  seen, 
the  EKF  implemented  in  this  thesis  performs  very  well  given 
the  noisy  measurements  available  from  the  truth  model  and 
the  specific  missile  trajectory  considered.  Care  must  be 
exercised  in  making  generalizations  about  measurement 
policies,  however,  since  redundant  measurements  or 
measurements  which  are  weighted  less  may  not  improve,  and 
may  perhaps  degrade  (in  the  case  of  mismodelling ) ,  the 
filter  estimates  for  an  EKF  application.  These 
considerations  will  be  taken  into  account  in  making  the 
following  comparisons,  which  is  the  object  of  this  study. 
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Between  Policy  1  and  Policy  3.  To  a  degree,  a 
comparison  between  measurement  policies  1  and  3 
demonstrates  the  degradation  possible  from  additional 
measurements.  Both  of  these  policies  involve  use  of  the 
gimballed  seeker  throughout  the  flight,  and  the  difference 
between  them  is  that  policy  1  involves  use  of  the  strapdown 
throughout,  while,  in  policy  3,  the  strapdown  seeker  is 
lost  at  midflight.  One  would  expect  better  performance 
from  policy  1  since  more  measurements  are  available  in  it. 
In  reality,  the  performance  is  almost  exactly  the  same  for 
both  policies.  An  inspection  of  the  plots  (Figures  D-l 
through  D-6  and  D-13  through  D-1B)  and  the  statistics 
(Table  IV)  reveal  very  similar  performance  for  both 
policies.  The  inconsistency  is  seen  in  a  comparison  of  the 
average  standard  deviations  for  the  z-states.  Policy  l's 
average  standard  deviation  of  32.0  ft  is  6%  higher  than 
that  for  policy  3,  30.2  ft.  The  values  are  so  close, 
however,  and  the  plots  so  identical,  especially  in  the  end 
conditions,  that  the  filter  performance  in  both  cases  is 
essentially  the  same.  These  results  indicate  that  loss  of 
the  strapdown  seeker  in  midflight  does  not  affect  filter 
performance . 

Between  Policy  2  and  Policy  4.  A  comparison  between 
the  filter's  performance  for  measurement  policy  2  and  its 
performance  for  policy  4  corroborates  the  results  of  the 
previous  comparison  between  policies  1  and  3.  The 
difference  between  policies  2  and  4  is  that  the  latter  set 
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involves  the  use  of  the  strapdown  seeker  throughout  the 
flight,  while  the  strapdown  seeker  loses  track  at  midflight 
in  the  former  set.  The  gimballed  seeker  comes  on  in 
midflight  in  both  policies.  Again,  the  average  standard 
deviations  for  these  two  policies  indicate  that  the  policy 
involving  the  fewest  measurements  gives  slightly  (about  5%) 
better  performance.  Again,  also,  the  plots  for  policies  2 
and  4  (Figures  D-7  through  D-12  and  D-19  through  D-24 )  are 
almost  identical,  and  the  average  standard  deviations  for 
both  y  and  z  are  very  close  for  both  policies  (5.6% 
difference  for  y  and  4.4%  difference  for  z).  Loss  of  the 
strapdown  seeker  seems  to  improve  the  filter  performance 
slightly.  However,  close  comparisons  of  corresponding 
plots  reveal  that  the  performance  is  essentially  tne  same 
for  both  policies,  especially  in  the  end  conditions, 
indicating  again  that  loss  of  the  strapdown  seeker  does  not 
affect  filter  performance  to  any  great  degree. 

The  interesting  effect  to  note  in  the  plots  for  both 
policy  2  and  policy  4  is  the  marked  reduction  in  the  filter 
covariance,  £(t),  curves  when  the  gimballed  seeker  comes  on 
at  16  sec.  As  seen  in  Figures  D-9  and  D-21,  for  example, 
there  is  a  secondary  transient  in  P(t)  and  the  mean  error 
at  the  transition  point  and  then  the  statistics  close  in 
rapidly  to  the  steady-state  end  conditions.  This  effect  is 
due  to  the  greater  weighting  placed  on  the  gimballed 
seeker's  angle  measurements  and  the  increased  observability 
introduced  by  the  gimballed  seeker's  angle-rate 
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measurements.  Use  of  the  gimballed  seeker  is  assumed 
always  to  be  possible  from  midflight  on,  but  the  major 
consideration  here  is  its  use  before  midflight.  A 
comparison  between  policies  1  and  3  and  policies  2  and  4 
will  provide  an  assessment  of  the  use  of  the  gimballed 
seeker  early  in  the  flight. 

Between  Policies  1  and  3  and  Policies  2  and  4.  Com¬ 
paring  policies  1  and  3,  in  which  the  gimballed  seeker  is 
used  throughout  the  flight,  to  policies  2  and  4,  in  which 

the  gimballed  seeker  is  not  used  until  lb  sec  into  the 

flight,  shows  that  there  is  a  distinct  advantage  to  overall 
performance  but  very  little  benefit  to  the  end  performance 
for  policies  1  and  3  over  policies  2  and  4.  The  average 
standard  deviations  are  approximately  twice  as  great  for 
policies  2  and  4,  which  indicates,  as  expected,  that  use  of 
the  gimballed  seeker  beginning  at  launch  time  greatly 

improves  filter  performance  for  the  whole  flight.  The  fact 
that  both  sets  of  average  standard  deviations  for  state  y 
and  for  state  z  show  a  consistent  improvement  for  policies 
1  and  3  over  policies  2  and  4  adds  a  great  deal  of 
confidence  to  the  indicated  benefit.  An  examination  of  the 
end  conditions  for  all  the  plots  reveals  that  there  is 

really  no  advantage  in  policies  1  and  3  over  policies  2  and 
4  with  regard  to  final  errors.  There  is  approximately  a  10 
to  20  ft  improvement  in  z-position,  a  2  to  3  ft/sec 
improvement  in  z-velocity,  and  no  real  improvement  in 
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y-position  cr  velocity  standard  deviations  at  the  final 
time  foe  policies  L  and  3 

The  lack  of  improvement  in  the  end  conditions  for  the 
policies  in  which  the  gimballed  seeker  is  tracking  the 
entire  time  of  flight  as  opposed  to  those  in  which  it  gains 
track  in  midflight  is  probably  due  to  the  length  of  the 
flight  time  remaining  after  16  sec.  The  gimballed  seeker 
is  on  for  12  sec  before  the  end  conditions  are  reached  and 
has  had  time  to  bring  the  estimates  to  steady-state.  Since 
the  filter  is  not  aware  of  the  exact  time -to- impact ,  use  of 
the  gimballed  seeker's  measurements  as  soon  as  they  are 
available  would  increase  the  confidence  in  the  end 
conditions,  whenever  they  are  reached.  Also,  the  overall 
performance  improvement  indicated  by  the  average  standard 
deviations  cannot  be  ignored.  For  all  these  reasons, 
incorporating  the  measurements  from  the  gimballed  seeker  as 
soon  as  possible  is  highly  recommended  based  on  these 
results. 

Summary 

The  results  derived  from  the  plots  for  the  measurement 
policies  have  revealed  important  conclusions  as  to  the 
value  to  be  placed  on  the  use  of  both  seekers  at  specific 
times  during  the  flight.  The  results  have  also  given  some 
insight  into  the  adequacy  of  the  EKF  design  of  this  thesis 
for  the  truth  model  and  flight  trajectory  considered.  The 
conclusions  derived  from  these  results  are  summarized  in 
detail  in  the  following  chapter. 
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VI.  CONCLUSIONS  AND  RECOMMENDATIONS 


Introduct  ior, 

The  six-state  extended  Kalman  filter  designed  in 
Chapter  III  was  simulated  as  an  estimator  onboard  a 
missile  which  flew  the  air-to-ground  trajectory  shown  in 
Figure  2-2.  The  filter  was  provided  with  measurements  from 
the  strapdown  seeker  and  gimballed  seeker  truth  models 
(Figures  2-2  and  ^-13)  developed  in  cnapter  II.  The 
measurements  were  made  available  as  specified  in  the 
measurement  policies  introduced  in  Chapter  I  and  tabulated 
in  Table  III  of  Chapter  IV.  The  ! liter  and  truth  models 
were  implemented  as  a  digital  computer  simulation 
according  to  the  implementation  considerations  presented  in 
Chapter  IV.  The  filter  was  tuned  in  a  Monte  Carlo  analysis 
against  the  truth  model  as  also  discussed  in  Chapter  IV. 
Simulations  were  run  to  obtain  comparisons  for  the  four 
measurement  policies  as  described  in  Chapter  V.  This 
chapter  presents  the  conclusions  drawn  from  the  results  and 
the  recommendations  for  expanding  on  the  work  done  for  this 
study. 

Conclus ions 

The  EKF  design  performed  well  in  estimating  the  y-  and 
z-position  and  velocity  states.  Since  the  missile  velocity 
vector  lay  almost  completely  in  the  x-direction  and  only 
angle  and  angle-rate  measurements  were  available,  the 
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filter  could  not  estimate  the  x-position  and  velocity 
states  until  the  last  6  sec  of  the  trajectory.  It  began 
estimating  the  x-stafes  at  this  point  because  the  range 
vector  rotated  such  that  its  x-component  decreased  with 
respect  to  its  y-  and  z -components .  The  observability 
problem  in  x  was  to  be  expected  with  only  angular 
measurements  available. 

The  use  of  simulated,  random,  Gaussian-distr ibuted 
initial  conditions  resulted  in  a  biasing  of  the  statistics 
taken  from  the  plots  for  the  results.  The  standard 
deviations  of  the  initial  conditions  were  very  consistent 
and  the  average  mean  errors  were  less  than  10  ft,  so  that 
the  average  standard  deviations  were  the  most  indicative  of 
performance  out  of  all  the  statistics  considered. 
Comparisons  of  the  average  standard  deviations  for  the  y- 
and  z-position  states  gave  good  indications  of  overall 
filter  performance  for  each  policy.  Visual  comparisons  of 
the  plots  provided  performance  evaluations  in  the  end 
conditions. 

The  following  comparisons  provided  insight  into  the 
potential  benefits  of  the  use  of  the  seekers: 

1)  Between  policy  1  and  policy  3:  gimballed  seeker 
on  throughout  flight  for  both,  strapdown  on 
initially  for  both,  but  off  at  midflight  for 
policy  3 

2)  Between  policy  2  and  policy  4:  gimballed  seeker 
on  at  midflight  for  both,  strapdown  meeker  on 
initially  for  both,  but  off  at  midflight  for 
policy  2 
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3)  Between  policies  1  and  3  and  policies  2  and  4 
collectively:  gimballed  seeker  on  throughout 

flight  for  former  set,  does  not  come  on  until 
midflight  for  latter  set 


The  conclusions  drawn  from  these  comparisons  are  as 
follows : 


1)  Loss  of  the  strapdown  seeker  at  midflight  (16  sec) 
does  not  degrade  filter  performance  substantially. 

2)  Use  of  the  gimballed  seeker's  measurements 
starting  at  the  launch  point  substantially 
improved  overall  filter  performance  over  their 
use  beginning  at  midflight. 

3)  Use  of  the  gimballed  seeker's  measurements 
starting  at  the  launch  point  rather  chan  at 
midflight  does  not  appreciably  improve  filter 
performance  at  the  end  conditions. 


Recommendations 

3ased  on  the  conclusions  presented  a.nd  the  insight 
gained  from  this  work,  the  following  recommendations  are 
made  to  guide  future  studies  on  the  dual-seeker  concept: 


1)  Different  sets  cf  initial  conditions  and, 
perhaps,  different  trajectories  should  be  used 
to  examine  the  observability  problem  more  fully. 

2)  The  filter  should  be  implemented  in  a  closed-loop 
guidance  law  to  analyze  further  the  measurements 
that  are  available  from  the  two  seekers. 

3)  Future  advances  in  strapdown  seeker  technology, 
especially  in  deriving  inertial  LOS  rates  from  a 
body-fixed  sensor,  should  be  considered  in  future 
studies  on  the  dual-seeker  concept. 
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APPENDIX  A 


Calculating  LOS  Angles 


Given  LOS  azimuth  and  elevation  angles,  a  and  e 
relative  to  one  coordinate  axes,  calculate  LOS  angles 
relative  to  the  desired  set  of  axes.  Referring  to 
Figure  2-5,  the  coordinate  transformation  matrix  between 
the  LOS  frame  L  and  an  arbitrary  reference  frame  A  is  given 
by: 


cose 

0 
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-sme  j  i 

cosa 

-sina 

0 

= 

0 

1 

0  ' 

sina 

cosa 

0 

sine 

0 

cosej 

_  0 

0 

1 

VA  =  C^vL 


where  V  is  an  arbitrary  vector  coordinatized  in  the  frame 
indicated  by  the  superscript.  The  transformation  matrix 
from  the  LOS  frame  to  the  reference  frame  is,  therefore, 


qA 


cosacose  -sinacose  -sine 
sina  cosa  0 

cosasine  -sinasine  cose 


( A-2 ) 


A  unit  vector  (denoted  by  ~  )  along  the  LOS 
coordinatized  in  the  reference  frame  is  expressed  as: 


A  ^  T  A 

T 
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cosacose 

=  cf  LOS1  =  cf 

L  L 
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sina 
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cosa  sine 

L_  _ 

<  A-3  ) 


This  vector  can  be  expressed  in  the  coordinates  of  some 
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other  reference  frame  B  by  the  Euler  transf ormation  between 
the  frames,  such  as  given  in  eq.  (1).  Defining  tne 
coordinate  transformation  between  frames  h  and  B  as: 


V®  =  cBV‘^  = 

"  A 


c  c  c 

C 1 1  13 


1 


c  c 

'"il 
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(A-4  ) 


The  unit  vector  LOS^  is  coord inat izea  in  the  B  frame  by 
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using  the  abbreviations  "c"  for  "cos"  and  "s"  for  "sin." 

With  the  components  of  the  unit  vector  of  the  LOS 
referenced  to  the  desired  frame  B  defined  by  eq.  (A-5),  the 
azimuth  and  elevation  angles  of  the  LOS  relative  to  the 
B-frame  axes  are  given  by: 


CA-6  ) 


(A-?  ) 
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appendix  b 

Filter  Measurement  Matrix 


This  appendix  covers  the  development  of  the  measurement 
matrix  H[V  ;xf t^ )]  Cor  the  filter  update. 

As  given  in  Chapter  III,  liCV’^V^  is  defined  as: 


r  ~  .  -,-i  3  n  r  X  ( t  ■ )  ,  t  M 

H[t i  ; t  i  )j  =  -^r1 - 

oX 


IX  -  XCt±-) 
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where,  again,  the  coefficient  through  are  the 
elements  of  the  transformation  matrix  from  the  missile  frame 
to  the  body  frame  defined  in  cq .  (1)  and  described  on  page  16 
The  partial  derivatives  as  defined  by  eq.  [37]  yieid  a 
6  x  to  ll[_t1;xft1  )]  matrix  for  the  b-state,  b  -  ncasui  ement 
filter  model  of  this  thesis.  An  example  of  the  evaluation 
°f  H  [t  ■  ;  x[t  L ' )]  is  [choosing  element  llj3  arbitrarily): 
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3  3 
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X1 
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X  3 


X  , 

x; i+x3 i  (B-19) 

Following  this  procedure,  all  36  elements  of  HTt^jxCt^  .Q 
are  given  as  follows: 

Defining : 


X 

=  Clx1+C2x3+C3x5 

(B-2) 
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In  summary,  this  appendix,  is  the  development  of  the 
measurement  matrix  H [t^ " )3  for  the  filter  update.  The 

elements  of  the  H  matrix  listed  as  eqs .  (B-5)  through  (B-40) 

are  evaluated  at  t ^  with  x(t^’)  each  filter  update  cycle. 
The  matrix  H  thus  calculated  is  then  used  to  calculate  the 

filter  gain  K(t^)  and  to  update  P(t^”)  as  shown  in  eqs.  (36] 

and  (39)  . 
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APPENDIX  C 


Filter  Tuning  Plots 
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Figure  C-3.  Both  Seekers,  Initial  Tuning  Plots 


Figure  C-4.  Both  Seekers,  Initial  Tuning  Plots 


Lgure  C-5.  Both  Seekers 


Loure  C-6.  Both  Seekers,  Initial  Tuning  Plots 
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gure  C- 11.  Strapdown  Seeker  On] 


110 


Figure  C-12.  Strapdown  Seeker  Only,  R.=.0012S  rad" 


Figure  C-13.  Strapdown  Seeker  Only, 


Figure  C-1S.  Strapdown  Seeker  Only,  R-.  =  .0028 


Figure  C-16.  Gimballed  Seeker,  Angle  Only,  R-7  =  .0012S  rad 


Figure  C-18.  Gimballed  Seeker,  Angle  Only,  R  “.00125  rad 
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gure  C-22.  Gimballed  Seeker,  Angle  Only,  K, =.000556  rad 


Figure  C- 23.  Gimballed  Seeker,  Angle-Rate  Only,  Rr=. 00125  rad 


-27.  Gimballed  Seeker,  Angl 
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Figure  C- 28.  Gimballed  Seeke 


Lgure  C-29.  Giraballed  Seeker,  Angle-Rate  Only,  R^.0078  rad 
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Figure  C-30.  Gimballed  Seeker,  Angle-Rate  Only,  a^.0078  rad 


Figure  C-31.  Gimballed  Seeker,  Angle-Rute  Only,  Kj=.C078  rud 


-32.  Gimballed  See 


Gimballed  Seeker,  Angle-Rate  Only, 


Figure  C-34.  Gimballed  Seeker,  Angle-Rate  Only,  Rr=.0078  rad 


Figure  C-3S.  Gimballed  Seeker,  Angle-Rate  Only,  R^-. 01125  rad 


Lgure  C-36.  Gimballed  Seeker,  Angle-Rate  Only 
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Plots  for  the  Results 
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Figure  D-2.  Both  Seekers  Throughout  Flight 


Seekers  Throughout  Right 
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Figure  D-4.  Both  Seekers  Throughout  Flight 


Figure  D-S.  Both  Seekers  Throughou 


Lgure  D-6.  Both  Seekers  Throughout  Flight 
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Figure  D-10.  Strapdown  Only  Initially,  Switch  10  Gimba 
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Lgure  D-12.  Strapdown  Only  Initially, 


Lgure  D-13.  Both  Seekers  Initially,  Strapdown  Off 
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Figure  D- 16 .  Both  Seekers  Initially,  Strapdown  Off  at  16  sec 
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igure  D-19.  Strapdown  Only  Initially,  GimbaU 


igure  D-20.  Strapdown  Only  Initially,  Gimballed  On  at  16  sec 
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Figure  D-24.  Strapdoivn  Only  In 
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